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Abstract 


Title  of  Thesis:  Linear  Control  Theory 

as  Applied  to  Smart  Structures 

Name  of  degree  candidate:  George  A.  Kantor 

Degree  and  year:  Master  of  Science,  1995 

Thesis  directed  by:  Associate  Professor  W.P.  Dayawansa 

Department  of  Electrical  Engineering  and 
Institute  for  Systems  Research 


This  thesis  investigates  linear  control  theory  as  applied  to  smart  structures. 
Specifically,  the  problem  of  active  vibration  damping  in  a  flexible  cantilever  beam 
using  piezo-electric  ceramic  crystals  (PZT)  as  sensors  and  actuators  is  addressed. 

The  problem  of  controlling  linear  time  invariant  systems  subject  to  hard 
input  constraints  is  considered.  Some  existing  methods  are  reviewed  and  some 
new  methods  are  presented. 

The  subject  of  rapid  prototyping  and  automatic  system  identification  is  ad¬ 
dressed.  Automatic  system  identification  techniques  are  developed  and  combined 
with  a  comercially  available  rapid  prototyping  system  to  create  a  test  bed  which 
can  be  used  to  rapidly  model  and  control  existing  plants. 

Closed  loop  control  laws  designed  to  actively  damp  vibrations  in  a  flexible 
cantilever  beam  were  tested  in  various  laboratory  experiments.  The  experiments 


are  described,  the  design  of  the  control  laws  is  discussed,  and  the  results  of  the 
experiments  are  presented. 

Finally,  impact  between  a  flexible  robotic  arm  and  a  fixed  sphere  is  adressed. 
A  model  for  the  impact  forces  is  developed  and  compared  with  experimentally 
determined  impact  data.  An  open  loop  control  law  using  a  neural  network  is 
implemented  to  control  the  magnitude  of  the  impact  force. 
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Chapter  1 


Introduction 


Recent  years  have  seen  a  large  amount  of  interest  generated  on  the  subject  of 
smart  structures.  While  there  are  no  rigorous  criteria  which  characterize  them, 
smart  structures  are  generally  constructed  of  components  which  have  sensors 
and/or  actuators  integrated  within  the  natural  structure  of  the  material.  This 
thesis  investigates  the  aspects  of  automatic  control  associated  with  smart  struc¬ 
tures.  Specifically,  the  problem  of  vibration  damping  in  a  flexible  aluminum 
cantilever  beam  using  piezo-electric  ceramic  crystals  (PZT)  mounted  to  the  sur¬ 
face  of  the  beam  as  both  sensors  and  actuators  is  addressed. 

This  thesis  can  be  broken  into  three  distinct  parts.  The  first  part,  Chapters  2 
and  3,  deals  with  the  problem  of  controlling  linear  systems  with  input  constraints. 
The  actuators  employed  in  smart  structures  are  generally  small  in  size  so  that 
they  can  be  integrated  seamlessly  within  the  material.  This  often  means  that 
the  control  effort  exerted  by  the  actuator  is  also  small.  Hence  constraints  on  the 
input  need  to  be  considered  when  designing  a  controller.  The  aluminum  beam 
with  PZT  actuators  is  a  good  example  of  this.  Safety  and  practical  considerations 
limit  the  maximum  voltage  which  can  be  applied  to  the  PZT.  Even  at  this 
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maximum  voltage,  the  force  applied  by  the  PZT  is  small  compared  to  the  force 
required  to  bend  the  beam.  Linear  control  theory  contains  a  large  number  of 
tools  for  designing  controllers  for  linear  systems,  but  a  surprisingly  small  amount 
of  work  has  been  done  on  designing  controllers  for  linear  systems  with  input 
constraints. 

The  first  step  in  approaching  the  constrained  input  problem  is  to  determine 
the  controllable  set  of  the  system.  This  is  the  subject  of  Chapter  2.  The  con¬ 
trollable  set  is  the  set  of  all  initial  conditions  for  which  there  exists  a  control 
which  drives  the  system  from  the  initial  condition  to  the  origin  in  finite  time 
while  satisfying  the  input  constraints.  The  controllable  set  can  be  approximated 
by  applying  the  maximum  principle  to  the  reverse  time  system.  This  method 
not  only  provides  an  approximation  of  the  controllable  set,  but  it  also  provides 
a  method  of  finding  an  open  loop  control  which  will  drive  any  initial  condition 
to  the  origin  in  the  shortest  time  possible. 

Chapter  3  discusses  some  control  laws  which  are  designed  to  stabilize  an 
unstable  linear  system  while  obeying  the  input  constraints.  The  controllers  pre¬ 
sented  in  Chapter  3  can  be  broken  into  two  groups:  classification  controllers  and 
modified  linear  controllers.  As  their  name  suggests,  the  first  group  uses  classifica¬ 
tion  techniques  such  as  nearest  neighbor,  look-up  tables,  and  neural  networks  to 
transform  the  open  loop  control  law  derived  in  Chapter  2  into  an  implementable 
closed  loop  control  law.  The  modified  linear  controllers  begin  with  a  low  gain 
linear  feedback  law  which  stabilizes  the  plant  in  a  desired  region  of  the  state 
space  while  obeying  the  input  constraint.  This  low  gain  controller  is  then  mod¬ 
ified  to  improve  performance  of  the  closed  loop  system.  The  Gutman-Hagander 
control  law  [13]  is  an  example  of  a  modified  linear  controller.  The  classification 
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controllers  have  the  advantage  that  they  stabilize  every  initial  condition  in  the 
controllable  set  while  the  modified  linear  controllers  are  generally  more  easily 
implemented. 

The  second  part,  Chapters  4  and  5,  describes  the  development  of  the  tools 
necessary  to  perform  the  experimental  work  to  follow.  Chapter  4  describes  the 
AC-100,  a  system  that  can  be  used  to  rapidly  design  and  implement  controllers. 
The  AC-100  was  used  to  help  implement  the  controllers  for  all  of  the  experimental 
work  in  Chapters  5-8. 

Most  modern  controller  design  techniques,  including  those  discussed  in  Chap¬ 
ter  3,  require  an  accurate  model  of  the  system  to  be  controlled.  Models  derived 
from  physical  principles  often  contain  parameters  which  are  difficult  to  measure 
accurately.  Hence,  an  empirical  method  of  determining  a  model  for  an  arbitrary 
plant  is  sought.  Chapter  5  presents  two  methods  of  experimentally  determining 
the  transfer  function  of  any  stable  linear  time  invariant  system.  These  methods 
are  recursive  least  squares  (RLS)  and  matching  pursuits  (MP).  RLS  is  capable  of 
estimating  a  real  rational  transfer  function  model  online  while  MP  is  a  wavelet 
based  method  capable  of  generating  accurate  low  order  models.  Both  methods 
are  implemented  using  the  AC- 100. 

The  third  part,  Chapters  6,  7,  and  8,  discusses  the  development  and  imple¬ 
mentation  of  controllers  for  the  flexible  cantilever  beam  in  different  configura¬ 
tions.  The  configuration  used  in  Chapter  6  is  a  flexible  aluminum  beam  with 
PZT  sensors  and  actuators  mounted  to  a  fixed  base.  The  control  objective  is 
to  actively  damp  vibrations  in  the  beam  using  closed  loop  control.  Here,  the 
constraint  satisfying  Gutman-Hagander  is  compared  with  two  controllers  which 
do  not  incorporate  any  input  constraints,  the  linear  quadratic  regulator  (LQR) 
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and  the  positive  position  feedback  (PPF)  controller. 

In  Chapter  7,  the  beam  from  Chapter  6  is  mounted  to  the  hub  of  a  DC  motor. 
The  motivation  for  this  configuration  comes  from  the  desire  to  study  and  control 
vibrations  in  spinning  objects  such  as  the  blades  of  a  fan  or  a  helicopter  rotor. 
The  rotation  creates  an  interesting  variation  of  the  fixed  beam  problem  because 
the  parameters  of  the  beam  change  as  the  angular  velocity  of  the  hub  increases. 
A  model  for  this  system  is  developed  and  linear  controllers  are  designed  to  damp 
vibrations  in  the  beam  at  fixed  motor  velocities.  These  controllers  are  then  joined 
together  to  form  a  gain  scheduling  controller  for  the  system  with  varying  motor 
velocity. 

The  effect  of  impact  forces  on  flexible  robotic  manipulators  is  the  subject 
of  a  great  deal  of  modern  research.  In  chapter  8,  a  one  link  flexible  robot  arm 
consisting  of  an  aluminum  beam  attached  to  the  hub  of  a  DC  motor  is  considered. 
A  model  which  can  predict  the  impact  forces  generated  in  a  collision  between 
the  arm  and  a  fixed  aluminum  sphere  is  derived  using  the  Hertz  law  of  impact. 
The  predictions  of  this  model  are  then  compared  with  experimental  impact  data. 
Finally,  a  neural  network  is  trained  from  experimental  data  to  generate  an  open 
loop  motor  control  signal  which  will  bring  the  arm  into  contact  with  the  sphere 
to  create  a  specified  impact  force. 

In  the  final  chapter,  the  main  results  of  the  thesis  are  briefly  reviewed.  As  al¬ 
ways,  many  interesting  problems  remain.  Some  of  these  are  identified  as  subjects 
for  future  research. 
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Chapter  2 


Finding  the  Controllable  Set 


The  plant  to  be  considered  is  a  controllable  linear  time  invariant  system  of  di¬ 
mension  n,  represented  as  follows: 

x(t)  =  Ax(t)  +  Bu(t)  (2.1) 

where  x  €  Rn  and  u  €  Rm.  In  addition,  the  control  inputs  are  constrained  to  be 
such  that 

\ui\  <  ki,  i  =  l,2,...,m.  (2.2) 

The  goal  is  to  find  a  control  u  :  [0,  oo)  — >■  Rm  that  drives  the  state  from  some 
xq  =  x(0)  to  the  origin.  For  controllable  linear  time  invariant  systems  without 
input  constraints  it  is  well  known  that  this  goal  can  not  only  be  satisfied,  but 
that  any  xo  €  Rn  can  be  driven  to  the  origin  in  arbitrarily  small  time  [29].  In  the 
case  with  constrained  inputs,  however,  this  result  does  not  hold.  Given  a  system 
described  by  Equations  2.1  and  2.2  there  may  be  initial  conditions  that  cannot 
be  driven  to  the  origin,  even  when  given  an  infinite  amount  of  time.  With  this 
in  mind,  the  objective  of  this  chapter  is  to  find  the  set  of  all  initial  conditions  £0 
for  which  there  exists  a  control  which  will  drive  the  state  of  Equation  2.1  from 
Xo  to  the  origin. 
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2.1  Preliminaries 


A  formal  concept  of  Controllable  and  Reachable  Sets  must  first  be  defined: 

Definition  2.1  Let  fi(t,xo,u)  denote  the  solution  at  time  t  to  Equation  2.1 
driven  by  control  u  with  the  initial  condition  :r(0)  =  x0.  Given  some  T  >  0, 
the  Controllable  Set  at  time  T,  denoted  by  Cj-,  is  defined  to  be  the  set  of  all 
p  G  Rn  for  which  there  exists  a  control  u  :  [0,  T]  — »  Rm  which  satisfies  Equation 
2.2  such  that  fi(T,p,u)  =  0.  The  Controllable  Set  denoted  by  C  is  defined  to 
be  the  limit  as  T  oo  of  Ct- 

Definition  2.2  GivenT  >  0,  the  Reachable  Set  at  time  T,  denoted  bylZT,  is 
defined  to  be  the  set  of  all  p  G  Rn  for  which  there  exists  a  control  u  :  [0,  T]  — »•  Rm 
which  satisfies  Equation  2.2  such  that  <p(T,0,u)  —  p.  The  Reachable  Set, 
denoted  by  7 Z,  is  defined  to  be  the  limit  as  T  — >  oo  of1ZT- 

Theorem  2.1  ([25])  Consider  the  linear  time  invariant  system  in  Equation  2.1 
with  initial  condition  x(0)  =  0  subject  to  the  input  constraint  given  by  Equation 
2.2.  Let  T  G  [0,  oo).  The  reachable  set  IZr  convex  and  compact. 

Note  that  if  the  control  u  :  [0,  oo)  — »  Rm  drives  the  system  from  x0  to  0  in 
time  T,  then  the  control  uB  defined  by 

uB(t )  =  u(T  —  t),  t  G  [0,  T] 

drives  the  system 

xB(t)  —  —( AxB(t )  +  BuB(t ))  (2.3) 

from  0  back  to  xo  in  time  T.  Equation  2.3  can  be  thought  of  as  the  reverse  time 
system  corresponding  to  Equation  2.1.  This  leads  to  the  following  fact: 
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Fact  2.1  The  controllable  set  for  a  given  system  is  equivalent  to  the  reachable 
set  for  the  corresponding  reverse  time  system. 

Fact  2.1  will  be  exploited  to  help  compute  the  controllable  set  of. 

Corollary  2.1  Let  T  E  [0,oo).  The  controllable  set  Cj-  of  the  system  given  by 
Equation  2.1  subject  to  the  input  constraint  given  by  Equation  2.2  is  convex  and 
compact. 

Corollary  2.1  follows  from  Theorem  2.1  using  Fact  2.1. 

Fact  2.2  If  the  matrix  A  in  Equation  2.1  is  Hurwitz,  then  the  controllable  set 
is  Rn. 

This  fact  is  clear.  When  A  is  Hurwitz  (i.e.  all  of  the  eigenvalues  of  A  have 
negative  real  part),  the  system  with  u  =  0  is  exponentially  stable.  Solutions 
starting  from  all  initial  conditions  in  Rn  drift  to  the  origin. 

In  the  sequel  it  will  be  necessary  to  identify  points  on  the  boundary  of  7 Zj 
and  Cr •  This  will  be  done  by  making  use  of  the  following  fact: 

Fact  2.3  Let  EL  be  a  convex,  compact  subset  of  Rn  which  contains  the  origin. 
Let  dEl  denote  the  boundary  of  El.  Then  x  E  dEl  if  and  only  if 

(h,x)  >  ( h,y ) 

for  all  y  E  EL,  some  h  E  Rn. 

The  quantity  (h,  x)  can  be  thought  of  as  the  length  of  the  projection  of  x 
onto  h  (see  Figure  2.1).  This  quantity  is  maximized  only  if  x  E  dEl.  To  see  this, 
suppose  x  maximizes  (h,x)  such  that  x  E  El.  If  x  €  int(EL),  then  there  exists 
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Figure  2.1:  Geometrical  Interpretation  of  ( h,x ) 

e  >  0  such  that  (x  +  eh)  £  f2.  Clearly,  ((x  +  eh),  h)  >  (x,  h),  so  by  contradiction 
x  must  be  on  the  boundary  of  Q,.  Conversely,  if  x  G  dQ  then  by  convexity  of  il 
there  exists  h  €  Rn  such  that  (h,  x)  >  ( h ,  y )  for  all  y  G 

Finally,  the  maximum  principle  will  be  needed  to  solve  for  the  controllable 
set.  For  the  purposes  of  this  paper,  it  can  be  stated  as  follows: 

Theorem  2.2  (Maximum  Principle  [31])  Consider  the  linear  time  invari¬ 
ant  given  by  Equation  system  2.1  with  initial  condition  x(0)  =  0  subject  to  the 
input  constraint  given  by  Equation  2.2.  Let  T  €  [0,cx>).  Let  p(t)  G  Rn  satisfy 
the  adjoint  equation 

Pit )  =  ~AT(t)p(t),  p{T)  =  h  (2.4) 
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Then  u  :  [0,  T]  — >  Rm  maximizes  the  quantity  (h,  x(T))  if  and  only  if 

pT(t)Bu(t)  —  sup{pT (t)Bv  v  £  Rm,  |w*|  <  ki,  i  =  1, 2, . . . ,  m}  (2.5) 
for  all  t  £  [0,  T] . 

Letting  bi  be  the  ith  column  of  B  yields 

m 

PT  if)  Bv  —  Y^pT(t)biVi.  (2.6) 

1=1 

The  value  of  pT(t)Bv  attains  its  supremum  if  and  only  if  every  element  of  the 

summation  in  the  right  hand  side  of  Equation  2.6  attains  its  supremum.  Hence, 

given  p(t),  the  optimal  u(t)  can  be  found  by  maximizing  each  element  of  the 

sum.  This  leads  to  the  following  formula  for  u(t ): 

' 

ki  if  pT(t)bi  >  0 

m(t)  =  <  -ki  if  pT(t)bi  <  0  (2.7) 

don’t  care  if  pT(t)bi  =  0 

2.2  Approximating  the  Controllable  Set 

Let  Ct  denote  the  controllable  set  at  time  T  of  the  system  given  by  Equation 
2.1  subject  to  the  input  constraint  given  by  Equation  2.2.  One  way  of  finding  a 
point  on  the  boundary  of  Ct  is  to  find  the  control  which  drives  the  state  from 
the  initial  condition  a;(0)  =  x0  to  the  final  condition  x(T )  =  0  for  the  initial 
condition  Xq  which  maximizes  the  quantity  (h,x o)  for  some  h  £  Rn.  Hence, 
one  is  faced  with  an  optimal  control  problem  on  a  system  with  varying  initial 
conditions,  a  problem  which  is  not  easily  solved  in  general. 

The  properties  of  the  reverse  time  system  provide  for  an  easier  solution  to 
this  problem.  Let  7 Zt  denote  the  reachable  set  at  time  T  of  the  reverse  time 
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system  with  uB  subject  to  the  constraint  and  with  the  initial  condition  x(0)  =  0. 
Since  the  controllable  set  of  any  system  is  equivalent  to  the  reachable  set  of  the 
corresponding  reverse  time  system,  7lT  = 

To  find  a  point  on  the  the  boundary  of  7 Zt  we  need  to  find  uB  :  [0,  T }  Rm 
such  that  the  quantity  ( h ,  x(T ))  is  maximized.  This  control  is  easily  found  using 
the  maximum  principle.  The  reverse  time  adjoint  system  is  given  by 

pB(t)  =  ATpB(ty,  pB(T)  =  h.  (2.8) 

Let  •)  denote  the  transition  matrix  of  A.  Then  the  solution  of  Equation 
2.8  can  be  written  as 

pB(t)  =  $T_A(T,t)h.  (2.9) 

Substituting  into  Equation  2.7  shows  that  the  control  which  maximizes  (h,  x(T)) 
for  the  reverse  time  system  is  given  by 

uf(t,  h)  =  kjsgn(-hT$-A(T,  t)bj),  j  =  1, 2, . . . ,  m.  (2.10) 

This  is  a  slightly  stonger  version  of  the  result  given  by  Pecsvaradi  and  Narendra 
[25]. 

Clearly,  for  any  h  G  Rn,  all  points  on  the  trajectory  of  the  reverse  time 
system  under  the  control  given  by  Equation  2.10  are  in  7 Zt-  Since  7 Zt  is  convex, 
all  points  in  the  convex  hull  of  such  trajectories  are  also  in  7 Zt-  Hence,  7 Zt  can 
be  approximated  by  taking  the  convex  hull  of  the  union  of  the  trajectories  of 
the  reverse  tim  system  under  the  control  given  by  Equation  2.10  for  a  variety  of 
directions  h.  An  algorithm  for  approximating  the  controllable  set  can  now  be 
written  as  follows: 

Step  1:  Choose  a  suitably  large  final  time  T. 
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Step  2:  Choose  k  directions  hi,  i  =  1, 2, . . . ,  k. 

Step  3:  Let  i  =  1. 

Step  4:  Find  pB(t),t  £  [0,T]  by  numerically  integrating  the 

reverse  time  adjoint  equation  (Equation  2.8)  backwards 
from  time  T  subject  to  the  final  condition  pB(T )  =  hi. 

Step  5:  Find  the  control  uB{t),t  £  [0,  T]  using  Equation  2.7. 

Step  6:  Find  the  ith  trajectory,  [xB(t),  t  £  [0,  T]J by  numeri¬ 
cally  integrating  the  reverse  time  system  (Equation  2.3) 
from  t  =  0  to  t  =  T  subject  to  the  initial  condition 
xB(0)  =  0. 

Step  7:  Increment  i  and  go  to  step  4  until  i  >  k. 

Step  8:  Let 


nT  =  A(\xB{t),  t  £  [0,  T]1 . , 

\  L  J  i 


where  A(-)  represents  the  convex  hull. 


2.3  Examples 


2.3.1  Example  1:  2-D  Case  With  Real  Eigenvalues 


Consider  the  system 


x{t)  = 


4  5 
3  -6 


x(t)  + 


(2.11) 


subject  to  the  constraint  |«|  <  1.  The  eigenvalues  of  the  matrix  A  are  Ai  =  —2 
and  A2  =  3. 
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Figure  2.2:  Approximation  of  Controllable  Set  for  Example  1 

An  approximation  of  the  controllable  set  of  this  system  can  be  found  by 
implementing  the  approximation  algorithm  using  MATLAB.  Figure  2.2  shows 
this  approximation.  The  solid  lines  represent  the  trajectories  of  the  system  under 
optimal  inputs  while  the  dotted  lines  represent  the  boundary  of  the  convex  hull 
of  these  trajectories,  or  the  boundary  of  7 Zt- 

For  this  example,  it  is  possible  to  solve  for  controllable  set  exactly.  The  PVA 
function  in  MATRIXx  can  be  used  to  find  the  (2  x  2)  matrix  M  such  that  the 
matrix  MAM -1  is  the  Real  Jordan  form  of  A  [16]. 

0.8944  -0.3162 

M  = 

-0.4472  0.9487 
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Employing  the  coordinate  transformation  z  —  M  xx  yields  the  new  system 

—9  D  9  9‘lfil 

z(t )  =  z(t )  +  u(t).  (2.12) 

0  3  3.1623 

These  are  two  uncoupled  first  order  ODE’s.  The  first  ODE, 

Zi{t)  =  -2  Zl(t)  +  2.2361u(i)  (2.13) 

is  exponentially  stable  while  the  second  ODE, 

z2(t)  =  3  z2(t)  +  3.1623 u(t)  (2.14) 

is  unstable.  If  z2  can  be  driven  to  0  in  time  T,  then  z\  can  be  allowed  to  drift 
to  the  origin  by  using  the  control  u(t)  =  0  for  all  t  >  T.  Hence,  the  total 
state  is  controllable  if  and  only  if  z2  can  be  driven  to  the  origin.  Clearly,  this  is 
true  if  and  only  if  |3z2(0)|  <  3.1623,  or  |22(0)|  <  1.054.  Transferring  back  to  x 
coordinates,  this  inequality  becomes 

|  -  0. 4472a:i(0)  +  0.9487x2(0)|  <  1.054 

The  plot  of  the  exact  controllable  set  is  contained  in  Figure  2.3.  As  should 
be  expected,  the  approximation  C  is  smaller  than  the  exact  controllable  set. 

2.3.2  Example  2:  2-D  Case  With  Complex  Eigenvalue 

Consider  the  system 

1  -9  0 

x(t)  —  x(t)  +  u(t)  (2.15) 

6  2  1 

subject  to  the  constraint  |«|  <  1.  The  matrix  A  has  eigenvalues  at  1.5  ±  j'7.331. 
The  reachable  set  for  this  system  was  approximated  using  MATLAB  and  is  plot¬ 
ted  in  Figure  2.4.  The  figure  shows  one  trajectory  which  spirals  outward  from 
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Figure  2.3:  Exact  Controllable  Set  for  Example  1 

the  origin  and  converges  to  a  periodic  orbit  which  circles  the  origin.  The  trajec¬ 
tory  converges  to  the  same  periodic  orbit  regardless  of  the  choice  of  h.  Hence, 
this  periodic  orbit  is  the  boundary  of  the  approximation  of  the  controllable  set. 

The  careful  study  of  the  reverse  time  system  corresponding  to  Equation  2.15 
yields  an  interesting  observation.  The  control  u{t)  =  1  for  all  t  >  0  does  not  drive 
the  system  to  the  boundary  of  its  reachable  set.  Instead,  the  system  converges 
exponentially  to  a  new  equilibrium  point  well  inside  the  reachable  set.  Figure 
2.5  shows  this.  The  solid  line  in  Figure  2.5  is  the  trajectory  of  the  reverse  time 
system  starting  at  a:(0)  =  0  with  the  constant  control  u(t)  =  1  for  all  t.  The 
dashed  line  marks  the  boundary  of  the  reachable  set.  In  order  to  approach  the 
boundary  of  the  reachable  set,  u(t)  must  switch  back  and  forth  between  +1  and 
—  1  at  a  frequency  that  is  approximately  equal  to  the  natural  frequency  of  the 
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0.5 


Figure  2.4:  Approximate  Controllable  Set  for  Example  2 

system.  If  the  reverse  time  system  was  a  physical  system,  the  u  which  drives 
the  state  to  the  boundary  could  be  thought  of  as  the  u  which  takes  the  most 
advantage  of  the  transfer  of  energy  in  the  system. 


15 


Figure  2.5:  Trajectory  of  Reverse  Time  System  (Example  2)  with  Constant  Input 
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Chapter  3 


Saturating  Control  Laws 


This  chapter  presents  some  controllers  for  the  constrained  input  problem.  The 
controllers  to  be  presented  fall  into  two  distinct  groups.  The  first  group,  classi¬ 
fication  controllers,  is  discussed  in  Section  3.1.  The  classification  controllers  use 
a  “bang-bang”  control  law  to  drive  the  state  of  the  system  to  the  origin  from 
any  initial  condition  contained  in  the  controllable  set.  The  second  group  of  con¬ 
trollers,  modified  linear  controllers,  is  discussed  in  Section  3.2.  These  controllers 
start  with  the  assumption  that  there  exists  a  linear  feedback  law  which  stabilizes 
the  system  while  satisfying  the  input  constraints  for  the  set  of  states  in  which  the 
plant  is  expected  to  operate.  Then,  as  the  name  suggests,  this  linear  feedback 
law  is  modified  to  improve  performance  of  the  closed  loop  system. 

3.1  Classification  Controllers 

Recall  from  Section  2.2  that  for  time  T  >  0,  h  6  Rn,  the  control 

uf(tih)  =  kjsgn(—hT$-A{T,t)bj),  j  =  l,2,...,m.  (3.1) 
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drives  trajectories  of  the  reverse  time  system 


xB(t)  =  — ( AxB(t )  +  BuB(t)),  xB(0)  =  0  (3.2) 

to  xB(T),  which  happens  to  be  on  the  boundary  of  the  controllable  set  at  time 
T.  The  control  u  :  [0,  T]  — *  Rm  given  by 

u(t)  =ub(T  -t),  t  e  [0,  T]  (3.3) 

drives  the  forward  time  system 

x(t)  =  Ax(t)  T  Bu(t)  (3.4) 

from  the  initial  condition  z(0)  =  xB(T )  to  the  origin  in  time  T.  Hence,  given 
any  x0  e  C  some  iterative  method  can  be  used  to  find  values  for  h  and  T  so 
that  xB{T)  will  equal  x0,  and  the  resulting  control  u  :  [0,T]  ->•  Rm  given  by 
Equations  3.1  and  3.3  will  drive  the  forward  time  system  from  x(0)  =  xq  to  the 
origin  in  time  T.  This  provides  a  method  of  finding  an  open  loop  control  to  drive 
any  x0  €  C  to  the  origin. 

A  naive  way  to  derive  a  discrete  closed  loop  control  law  for  a  the  system  would 
be  to  compute  the  open  loop  control  u  at  each  step  using  the  above  method. 
This  technique  would  work,  but  the  extremely  large  number  of  computations 
necessary  at  each  step  would  prohibit  its  use  for  most  applications. 

A  more  practical  approach  comes  from  formulating  the  problem  as  a  classi¬ 
fication  problem.  At  any  given  time,  the  input  given  by  Equations  3.1  and  3.3 
will  take  one  of  a  finite  number  of  possible  values.  Specifically,  for  a  system  with 
m  inputs,  there  are  at  most  2m  different  values  which  the  input  vector  can  take. 
Hence  each  state  can  be  assigned  one  of  a  finite  number  of  classes  according  to 
the  input  vector  which  should  be  used  to  drive  the  state  to  the  origin. 
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In  general,  complicated  switching  surfaces  separate  the  states  belonging  the 
different  classes.  It  is  usually  difficult  to  represent  these  surfaces  in  closed  form, 
but  their  effect  can  be  approximated.  To  do  this,  a  large  number  of  states  in  C  are 
selected.  The  open  loop  control  associated  with  each  state  is  then  computed  and 
each  state  is  classified  according  to  the  input  vector  which  should  be  used  at  that 
state.  This  creates  a  data  set  consisting  of  states  in  C  and  their  corresponding 
classes.  The  controller  must  then  be  able  to  classify  arbitrary  states  in  C  based 
on  the  information  contained  in  the  data  set.  Three  methods  of  classification 
are  described  below. 

3.1.1  Nearest  Neighbor 

The  concept  of  nearest  neighbor  classification  is  straightforward:  the  class  of  a 
given  state  is  assigned  to  be  the  class  of  the  nearest  state  contained  in  the  data 
set.  Implementation  of  nearest  neighbor  classification  is  not  quite  so  easy.  Since 
the  data  set  is  generally  large,  searching  through  it  for  the  nearest  neighbor  can 
take  a  long  time. 

One  way  to  alleviate  this  problem  is  to  use  an  efficient  storage  and  retrieval 
system  such  as  the  k-d  tree  [11].  The  k-d  tree  is  a  generalization  of  the  binary 
decision  tree  often  used  for  scalar  data  searches.  If  the  data  set  has  N  elements, 
the  time  necessary  to  search  the  list  linearly  is  proportional  to  N.  The  time  nec¬ 
essary  to  search  the  list  using  the  k-d  tree  algorithm  is  proportional  to  log2(iV). 
For  example,  if  the  data  set  contains  10,000  elements,  a  k-d  tree  search  runs 
about  750  times  faster  than  a  linear  search. 

Nearest  neighbor  classification  provides  the  most  accurate  method  of  classi¬ 
fication  available.  It’s  accuracy  is  limited  only  by  the  resolution  of  the  data  set 
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and  the  time  allowed  for  the  search. 


3.1.2  Look-up  Table 

Preprocessing  the  data  set  to  put  it  in  the  format  of  a  look-up  table  can  eliminate 
the  searching  time  all  together.  First,  a  grid  is  created  over  C.  Then,  each  point 
on  the  grid  is  asigned  a  class  using  its  nearest  neighbor.  The  grid  is  then  stored 
in  an  n-dimensional  array  or  look-up  table.  Now,  classifying  an  unknown  state 
can  be  done  by  rounding  the  state  to  the  nearest  point  on  the  grid  and  looking 
up  its  class  in  the  array  or  look-up  table. 

The  look-up  table  method  of  classification  runs  much  faster  than  the  nearest 
neighbor  approach,  but  this  gain  comes  at  the  cost  of  accuracy.  Also,  while 
this  method  works  well  for  low  dimensional  systems,  higher  dimensional  systems 
require  prohibitively  large  amounts  of  memory. 

3.1.3  Neural  Network 

Neural  networks  have  been  shown  to  work  well  as  classification  controllers.  In 
fact,  L.G.  Kraft  and  D.  Dietz  have  succesfully  applied  a  CM  AC  neural  network 
to  solve  the  time  optimal  control  problem  [18],  a  problem  which  is  actually  a 
specific  case  of  the  constrained  input  problem.  The  CM  AC  neural  networks  are 
easy  to  train,  but  here  backpropagation  neural  networks  are  used  due  to  the 
wide  availability  of  information  and  software  on  the  subject  [7],  [15]  . 

A  backpropagation  neural  network  for  use  as  a  classifying  controller  for  a 
system  with  n  states  and  m  inputs  must  have  n  inputs  and  m  outputs.  Choosing 
the  number  of  hidden  layers  and  the  number  of  neurons  per  layer  is  a  subject  of 
current  research  [5].  Here  these  numbers  are  found  by  trial  and  error.  The  same 
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holds  for  the  transfer  function  at  each  layer,  however  good  results  can  usually 
be  obtained  by  using  a  sigmoid  function  for  elements  of  the  hidden  layers  and  a 
linear  function  for  the  output  layer. 

The  network  is  then  trained  on  the  data  set.  The  states  in  the  data  set  are 
presented  as  inputs  and  the  m-vector  associated  with  the  class  is  presented  as 
the  target.  Once  the  network  is  satisfactorily  trained,  a  second  data  set  should 
be  created  to  test  the  accuracy  of  the  neteork  for  data  different  from  the  training 
data. 

When  the  network  is  used  as  a  controller,  each  input  to  the  plant  should 
always  be  on  one  of  its  constraints.  Hence,  if  s*  is  the  ith  output  of  the  neural 
network,  then  Ui  is  assigned  as  follows: 


—ki  if  Si  <  0 

^  =  (3.5) 

ki  if  Si>0 

< 

The  use  of  a  neural  network  to  solve  the  constrained  input  problem  has 


several  advantages  over  the  nearest  neighbor  approach.  First,  the  neural  network 
is  trained  with  the  data  set  off  line,  so  the  controller  does  not  need  access  to  the 


data  set  while  running.  Hence  the  problem  of  memory  space  does  not  present 
itself.  Also,  since  the  neural  network  finds  it’s  answer  by  making  a  relatively 
small  number  of  simple  calculations,  it  runs  much  faster  than  nearest  neighbor, 
which  has  to  search  through  the  entire  data  set  to  obtain  each  answer. 


3.1.4  An  Example 

Consider  the  system 

3  4  0 

x{t )  =  x(t )  +  u(t)  (3.6) 

-9  2  1 
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subject  to  the  constraint  |tt|  <  1.  A  data  set  was  compiled  as  described  above. 
The  system  was  then  simulated  for  each  of  the  3  described  classification  con¬ 
trollers. 


Nearest  Neighbor  Controller 

The  system  was  simulated  on  a  Sparc  20  using  the  method  of  nearest  neighbor 
to  determine  the  stabilizing  input  in  a  closed  loop  manner.  The  nearest  neighbor 
algorithm  was  implemented  with  the  help  of  the  k-d  tree.  Code  for  the  storage 
and  retrieval  of  data  from  the  k-d  tree  was  graciously  provided  by  J.  Schneider 
[30].  The  results  are  plotted  in  Figure  3.1.  Note  that  the  switching  curve  plot¬ 
ted  in  Figure  3.1(a)  is  the  most  accurate  possible  approximation  of  the  actual 
switching  curve  from  the  given  data  set. 


Look-up  Table  Controller 


To  implement  a  look-up  table  controller,  a  100  by  100  grid  with  X\  and  x2  evenly 
distributed  between  —0.3  and  0.3  was  created.  Each  point  on  the  grid  was  then 
classified  using  nearest  neighbor  implemented  with  a  k-d  tree.  The  resulting 
classes  are  then  stored  in  a  2-dimensional  array  G  such  that 


G 


'99(m  -  (-0.3))  +  99(x2  -  (-0.3))  +  ^ 


0.6 


0.6 


=  class  (or).  (3.7) 


An  x  which  is  not  on  the  grid  can  be  classified  by  rounding  it  to  the  nearest 
point  on  the  grid.  Hence 

class(x)  =  G  (round  (”&  ~  <~°'3))  +  l)  ,  round  +  x))  . 

(3,8) 
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(a)  (b) 


Figure  3.1:  Example  using  nearest  neighbor  control,  (a)  switching  curve,  (b) 
trajectory  of  system  under  nearest  neighbor  control 


23 


0.3 

0.2 

0.1 


-0.1 
-0.2 

Figure  3.2:  Example  with  data  set  preprocessed  into  a  2  dimensional  matrix, 
(a)  approximate  switching  curve,  (b)  trajectory  under  control 

The  results  of  the  simulation  are  found  in  Figure  3.2.  Note  the  compari¬ 
son  between  the  approximate  switching  curve  plotted  in  Figure  3.2(a)  and  the 
switching  curve  found  using  nearest  neighbor,  Figure  3.1(a). 

Neural  Network  Controller 

A  2-input,  single  output  backpropagation  neural  network  was  trained  using  the 
MATLAB  Neural  Network  Toolbox  [7].  The  network  was  chosen  to  have  2  hidden 
layers  with  10  neurons  in  each  hidden  layer.  A  logarithmic  sigmoid  function  was 
used  for  the  two  hidden  layers  while  a  linear  transfer  function  was  used  to  the 
output  layer.  The  system  was  simulated  using  the  resulting  neural  network  for 
feedback  control.  The  results  of  the  simulation  are  plotted  in  Figure  3.3. 
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(a)  (b) 


-0.2  -0.1  0  0.1  0.2  -0.2  -0.1  0  0.1  0.2 
xl  xl 


Figure  3.3:  Example  using  a  neural  network  for  feedback  control,  (a)actual  and 
approximated  switching  curves,  (b)  trajectory  under  control. 
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3.2  Modified  Linear  Controllers 


As  the  name  implies,  modified  linear  controllers  start  with  a  linear  state  feedback 
which  is  then  modified  to  improve  its  performance.  These  controllers  will  not,  in 
general,  stabilize  the  entire  controllable  set.  It  is  assumed  that  the  set  of  possible 
initial  conditions  taken  on  by  the  plant  is  some  subset  of  the  controllable  set. 
Further,  it  is  also  assumed  that  there  exists  a  linear  state  feedback  law  which 
stabilizes  the  plant  while  satisfying  the  input  constraint  for  all  possible  initial 
conditions.  If  these  conditions  are  not  met  then  a  modified  linear  controller 
cannot  be  used. 

3.2.1  Preliminaries 

First,  some  relevant  sets  are  defined. 

Definition  3.1  Define  D  to  be  the  set  containing  all  possible  initial  conditions 
which  can  be  taken  by  the  plant. 

Definition  3.2  Let  L  be  an  m  x  n  matrix  of  constant  real  numbers.  Define 
E(L)  to  be  the  set  of  all  states  such  that  the  m-vector  —Lx  satisfies  the  input 
constraints  given  by  Equation  2.2.  In  other  words,  if  U  represents  the  ith  row  of 
L, 

E{L)  =  {rre  Rn\  \kx\  <  fe}  . 

Finally,  notions  of  two  different  saturation  functions  are  formalized. 
Definition  3.3  Let  v  be  an  m-vector.  Define  the  sat  function  to  be 
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3.2.2  Gutman-Hagander 

P.  Gutman  and  P.  Hagander  have  proposed  a  modified  linear  controller  which 
uses  two  linear  feedback  laws  which  are  added  together  and  then  saturated  using 
the  sat  function  [13].  First,  an  m  x  n  feedback  matrix  L  is  computed  so  that 
the  feedback  law  u  =  —BLx  stabilizes  the  system  while  satisfying  the  input 
constraints  for  all  initial  conditions  xq  €  D.  One  way  of  doing  this  is  to  solve 
the  Linear  Quadratic  Optimal  control  problem,  increasing  the  penalty  on  the 
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control  until  the  constraints  are  met.  Next,  annxn  symmetric  positive  definite 
matrix  P  is  chosen  such  that 

P(A  -  BL)  +  (A-  BL)tP  <  0.  (3.13) 

In  order  for  P  to  be  a  valid  choice,  there  must  exist  c  >  0  such  that 

supa;TPa;  <  c  <  min  (  ,  1 .  (3-14) 

An  m  x  m  diagonal  matrix  M  is  chosen  such  that  all  of  its  elements  are  greater 
than  or  equal  to  0.  Finally,  the  feedback  control  law  becomes 

s  u  =  sat((-BL  -  MBtP)x).  (3.15) 

The  resulting  closed  loop  system  is  guaranteed  to  be  stable  for  all  initial 
conditions  x(0)  £  D.  The  performance  of  the  closed  loop  system  can  be  tuned 
by  adjusting  the  elements  of  M  during  simulations. 

3.2.3  Control  Using  the  msat  Function 

The  msat  function  proves  to  be  very  useful  for  the  control  of  stable  linear  systems 
with  constrained  inputs  [14].  The  basis  of  this  usefulness  is  stated  in  the  following 
fact: 

Proposition  1  Consider  an  assymptotically  stable  linear  time  invariant  system 
of  the  form  given  in  Equation  2.1.  Let  L  be  a  constant  m  x  n  feedback  matrix. 
Assume  that  there  exists  a  symmetric,  positive  definite  ( n  x  n)  matrix  P  such 
that 

PA  +  AtP  <  0  (3.16) 

and 

P(A  —  BL)  +  (A  —  BL)tP  <  0.  (3.17) 
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Then  the  closed  loop  system  with  msat  saturated  feedback 


x  =  Ax  —  B  msat(Lx)  (3.18) 

is  asymptotically  stable. 

Proof 

Equations  3.16  and  3.17  imply  that 

P(A  -  olBL )  +  (A  -  aBL)TP  <  0  (3.19) 

for  all  a  G  [0, 1].  Let  E(L )  be  the  set  of  all  x  G  Rn  such  that  the  m- vector  —Lx 


satisfies  the  input  constraint.  Let 

V(x)  =  xTPx  (3.20) 

be  a  Lyapunov  function  candidate  for  the  nonlinear  system 

x  —  Ax  —  B  msat(Lx) 

=  Ax  —  a(x)BLx  (3.21) 

where  o(a:)  G  [0, 1]  for  all  x  G  Rn.  Then 

V(x )  =  xTPx  +  xTPx  (3.22) 

=  xT{P{A  -  a{x)BL)  +  {A-  a{x)BL)TP)x  (3.23) 

<  0  for  all  x  G  Rn.  (3.24) 

□ 


Hence,  L  can  be  chosen  such  that  the  closed  loop  system  meets  design  spec¬ 
ifications  by  using  any  of  the  wide  variety  of  available  linear  controller  design 
tools  (LQR,  pole  placement,  etc.).  Then,  if  there  exists  a  P  which  satisfies 
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Figure  3.4:  Important  sets  for  the  msat  controller 

Equations  3.16  and  3.17,  the  closed  loop  system  resulting  from  Equation  3.18 
will  perform  according  to  specifications  close  to  the  origin  and  is  guaranteed  to 
be  asymtotically  stable  everywhere  in  Rn. 

Figure  3.4  provides  a  graphical  description  of  the  important  sets  involved 
in  the  msat  controller.  E(L)  represents  the  set  of  states  for  which  the  ra-vector 
—Lx  satisfies  the  input  constraint  given  by  Equation  2.2.  12  represents  the  largest 
subset  of  E(M)  which  is  positively  invariant  under  the  system 

x  =  (A-  BL)x.  (3.25) 

If  the  initial  condition  of  the  closed  loop  system  is  in  12,  then  the  system  performs 
to  the  specifications  selected  when  choosing  M.  If  the  initial  condition  is  outside 
12  then  the  closed  loop  system  is  asymtotically  stable. 
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3.2.4  Dual  Mode  Controllers 


Dual  mode  controllers  use  a  “high  gain”  linear  state  feedback  law  close  to  the 
origin  and  use  a  “low  gain”  linear  state  feedback  far  away  from  the  origin  [13]. 
The  closed  loop  system  then  performs  according  to  desired  performance  criterion 
close  to  the  origin,  where  the  high  gain  controller  meets  the  input  constraints. 
The  low  gain  feed  back  is  then  chosen  to  satisfy  less  stringent  performance  cri¬ 
terion,  such  as  stability,  for  all  initial  conditions  in  D.  The  analysis  of  the  msat 
function  presented  by  P.J.  Gyugyi  and  G.  Franklin  [14]  provides  motivation  for 
the  following  sufficient  condition  for  dual  mode  controller  stability: 

Proposition  2  Consider  the  system  given  by  Equation  2.1  subject  to  the  input 
constraints  given  by  Equation  2.2.  Let  L  an  M  both  be  m  x  n  state  feedback 
matrices  such  that  both  systems 


x  =  (A  —  BL)x 

(3.26) 

and 

x  =  (A  —  BM)x 

(3.27) 

are  asymptotically  stable.  Let  E(M)  represent  the  set  of  states  for  which  the 
m-vector  —Mx  satisfies  the  input  constraint  and  let  f2i  represent  the  largest 
subset  of  E(M)  which  is  positively  invariant  under  the  system  give  by  Equation 
3.27.  Likewise,  let  E(L)  represent  the  set  of  states  for  which  the  m-vector  —Lx 
satisfies  the  input  constraint  and  let  Q2  represent  the  largest  subset  of  E(L)  which 
is  positively  invariant  under  the  system.  WLOG,  let  C  D2  ( See  Figure  3.5). 
Further,  assume  that  there  exists  a  symetric,  positive  definite  ( n  x  n )  matrix  P 
such  that 

P(A  -  BL)  +  (A-  BL)tP  <  0  (3.28) 
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The  proof  is  very  similar  to  the  proof  of  Proposition  1.  Conditions  3.28  and 
3.29  provide  the  Lyapunov  function  V(x )  =  xTPx  with  V{x)  <  0  for  all  x  in  the 
invariant  set 

Proposition  2  provides  a  straightforward  approach  to  dual  mode  controller 
design.  First,  choose  L  to  so  that  the  control  law  u  =  —Lx  stabilizes  the 
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system  while  satisfying  the  input  constraint  for  all  initial  conditions  xQ  £  D. 
Then  choose  M  so  that  the  control  law  u  =  —  Mx  causes  the  resulting  closed 
loop  system  to  perform  according  to  the  design  specifications.  Finally  check  to 
see  if  Conditions  3.28  and  3.29  are  satisfied.  If  so,  then  the  control  law  given 
by  Equation  3.30  will  cause  the  resulting  closed  loop  system  to  meet  design 
specifications  for  all  initial  condition  xo  £  Qi  and  stable  for  all  xq  £  D. 

The  design  process  could  be  made  considerably  easier  if  there  were  some 
conditions  on  A,  B,  L,  and  M  that  would  guarantee  that  Conditions  3.28  and 
3.29  hold.  This  is  left  for  future  work. 


3.3  Conclusion 

Several  controllers  for  use  with  LTI  systems  subject  to  input  constraints  are  pre¬ 
sented  here.  These  controllers  can  be  broken  into  two  distinct  groups:  classifying 
controllers  and  modified  linear  controllers. 

The  classifying  controllers  transform  the  open  loop  stabilizing  control  found 
in  Chapter  2  into  a  closed  loop,  “bang-bang”  control  law.  The  three  classifying 
controllers  presented  were  nearest  neighbor,  look-up  table,  and  neural  network. 
The  nearest  neighbor  controller  provides  the  most  accurate  method  implement¬ 
ing  the  switching,  however  it  is  also  the  slowest  of  the  three.  The  look-up  table 
method  is  very  fast,  but  it  requires  large  amounts  of  memory,  especially  for  high 
dimensional  systems.  The  neural  network  controller  is  not  as  fast  as  a  look-up 
table,  but  it  is  much  faster  than  the  nearest  neighbor  controller.  Additionally, 
the  neural  network  requires  very  little  memory,  making  it  easier  to  implement 
than  a  look-up  table. 
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Currently,  the  Gutman-Hagander  controller  is  the  most  useful  of  the  modified 
linear  controllers.  The  Gutman-Hagander  design  algorithm  can  be  applied  to  any 
LTI  system  is  and  easily  implemented. 
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Chapter  4 


Rapid  Prototyping  Using  the  AC-100 


To  facilitate  the  implementation  of  the  experiments  that  follow  in  the  thesis, 
a  rapid  prototyping  station  centered  around  Integrated  Systems  Inc.’s  AC-100 
system  was  constructed.  The  development  of  this  rapid  prototyping  station, 
or  test  bed,  deserves  some  mention  for  a  couple  reasons.  Firstly  the  author 
concentrated  a  large  portion  of  his  efforts  towards  building  the  test  bed  and 
learning  how  to  use  it.  More  importantly,  the  test  bed  was  designed  with  no 
single  control  application  in  mind.  As  a  result,  the  system  allows  the  rapid 
development  and  implementation  of  control  strategies  for  any  given  system.  It 
will  undoubtably  prove  to  be  a  valuable  asset  to  the  research  efforts  of  the 
Intelligent  Servosystems  Laboratory  (ISL). 

This  chapter  briefly  describes  the  construction  and  use  of  the  system.  It  may 
be  used  as  a  starting  point  for  someone  wishing  to  use  the  system  for  his  own 
experiments. 
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4.1  The  AC- 100 


Integrated  Systems  Inc.’s  AC-100  is  the  heart  of  this  rapid  prototyping  station. 
Software  tools  contained  in  AC-100  provide  the  user  with  the  ability  to  design 
and  simulate  controllers,  select  input  and  output  devices,  generate  C  code  to  run 
the  controller,  download  the  controller  to  a  digital  signal  processing  (DSP)  chip, 
and  finally  execute  the  controller  in  real  time. 

Most  aspects  of  the  AC- 100  run  on  a  SPARCstation  IPX.  As  of  this  writing, 
the  AC-100  software  is  only  licensed  to  run  on  the  SPARC  known  as  tulip  in 
the  ISL.  The  controller  is  designed,  I/O  parameters  are  specified,  and  C  code  is 
generated  on  the  SPARC.  The  resulting  code  is  then  downloaded  via  FTP  to  a 
Dell  486  PC  (rhea-pc)  which  houses  the  DSP  chip  as  well  as  the  various  I/O 
devices  and  their  drivers.  The  controller  is  compiled  and  executed  on  the  PC, 
but  the  user  sends  commands  to  the  controller  from  the  SPARC  via  the  FTP 
link.  A  graphical  representation  of  the  AC-100  system  is  given  in  Figure  4.1. 

The  various  aspects  of  the  AC100  are  described  below. 

4.1.1  MatrixX  and  SystemBuild 

MatrixX  is  a  powerful  matrix  manipulation  program.  It  contains  a  wide  variety 
of  matrix  functions  designed  specifically  for  use  by  control  engineers.  When  used 
as  part  of  the  rapid  prototyping  station,  MatrixX  can  be  used  to  implement  a 
desired  control  algorithm  (e.g.  LQR)  and  produce  a  controller  for  a  given  plant 
model. 

SystemBuild,  a  component  of  MatrixX,  is  an  interactive  block  diagram  editor 
which  can  be  used  to  graphically  construct  and  simulate  complex  dynamical 
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AC  1 00  Description 


I - 1 


Figure  4.1:  AC-100  block  diagram 
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systems.  It  has  the  capability  to  numerically  analyze  continuous  time  dynamics, 
discrete  time  dynamics,  and  finite  state  machine  descriptions  as  well  as  systems 
containing  any  combination  of  the  three.  For  use  with  the  AC-100,  SystemBuild 
is  used  to  construct  a  controller.  The  controller  will,  in  general,  have  external 
inputs  and  outputs,  all  of  which  can  be  given  mnemonic  labels  by  the  user. 
These  inputs  and  outputs  represent  the  plant’s  sensor  signals  and  control  inputs 
as  well  as  controller  parameters  and  display  outputs.  Once  a  controller  which 
works  satisfactorily  in  simulation  is  designed,  SystemBuild  is  used  to  generate 
a  real  time  file,  or  .rtf  file  which  contains  all  of  the  information  necessary  to 
proceed  with  the  prototyping  procedure. 

4.1.2  Interactive  Animation  Builder 

The  Interactive  Animation  Builder  (IAB)  allows  the  user  to  construct  a  graphical 
instrumentation  panel  which  can  be  used  to  send  commands  to  and  monitor  the 
outputs  of  the  controller  running  on  the  PC.  Numerical  inputs  can  be  sent  to  the 
controller  via  sliders  and  dials  and  logical  inputs  are  sent  using  various  types  of 
switches.  Controller  information  can  be  displayed  using  strip  charts,  dials,  and 
various  other  graphical  displays. 

To  use  the  IAB  with  the  AC-100,  the  user  constructs  the  desired  instru¬ 
ment  panel  configuration,  then  uses  the  information  contained  in  the  .rtf  file  to 
connect  the  inputs  and  outputs  of  the  elements  on  the  instrument  panel  to  the 
appropriate  controller  inputs  and  outputs,  which  still  have  the  mnemonic  labels 
given  in  SystemBuild. 
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4.1.3  Hardware  Connection  Editor 


As  its  name  implies,  the  Hardware  Connection  Editor  (HCE)  is  used  to  connect 
the  controller  inputs  and  outputs  to  the  appropriate  I/O  devices.  Like  the  IAB, 
the  HCE  uses  the  information  contained  in  the  .rtf  file  so  that  the  controller 
inputs  and  outputs  still  have  the  mnemonic  labels  given  in  SystemBuild. 

The  ISL’s  version  of  AC-100  has  the  following  I/O  capabilities: 

•  6  channels  digital  to  analog  converter 

•  16  channels  analog  to  digital  converter 

•  72  channels  of  digital  I/O  (programmable) 

•  2  serial  channels  (RS-232-C  or  RS-422) 

•  4  channels  quadrature  position  encoder 

•  4  channels  pulse  width  modulation 

•  Motorola  68332  processor 

4.1.4  Compiling  the  Controller 

The  AutoCode  program  generates  C  code  from  the  controller’s  .rtf  file  at  the 
touch  of  a  button.  After  that,  AC-100  provides  tools  that  automatically  down¬ 
load  the  C  code  to  the  PC,  link  it  with  the  appropriate  device  drivers,  compile 
the  information,  and  load  it  onto  the  DSP  chip.  Once  this  is  done,  the  con¬ 
troller  can  be  started,  monitored,  and  manipulated  from  the  SPARC  using  the 
instrumentation  panel  created  with  the  IAB. 
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4.2  Physical  Description 


To  facilitate  use  of  the  AC- 100,  a  special  cart  has  been  designed  and  constructed. 
The  PC  sits  on  top  of  the  cart.  The  various  I/O  devices  on  the  PC  have  been 
connected  to  a  number  of  easily  accessible  and  appropriately  chosen  connectors 
mounted  to  a  large  panel  on  the  front  of  the  cart.  Two  power  supplies  and  three 
general  purpose  amplifiers  also  reside  on  the  cart.  Hence,  it  is  equipped  to  serve 
as  a  controller  for  a  wide  variety  of  plants  with  little  or  no  additional  equipment. 
The  cart  has  been  equipped  with  a  long  ethernet  cable  so  it  is  easily  transported 
to  anywhere  in  the  ISL.  A  photograph  of  the  cart  is  shown  in  Figure  4.2. 

4.3  Conclusion 

The  AC- 100,  facilitated  by  the  cart  on  which  it  is  mounted,  allows  for  rapid 
design  and  implementation  of  control  strategies  for  a  wide  variety  of  potential 
plants.  This  rapid  prototyping  capability  will  greatly  reduce  the  amount  of 
time  and  effort  required  to  translate  theory  into  practice,  furthering  the  research 
capabilities  of  the  ISL. 
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Chapter  5 


System  Identification 


Most  modern  controller  design  techniques,  including  those  discussed  in  the  pre¬ 
vious  chapters,  require  an  accurate  model  of  the  system  to  be  controlled.  Models 
derived  from  physical  principles  can  provide  a  great  deal  of  valuable  insight  into 
a  given  system,  but  many  times  these  models  contain  parameters  which  are 
difficult  if  not  impossible  to  measure  accurately.  Hence  a  more  experimental 
approach  is  required.  We  would  like  to  obtain  the  model  of  an  unknown  plant 
given  a  known  input  and  the  corresponding  measured  output.  This  is  the  goal 
of  system  identification.  This  chapter  presents  two  methods  of  experimentally 
determining  the  transfer  function  of  a  stable  linear  time  invariant  system.  Re¬ 
cursive  least  squares  (RLS),  the  first  method  discussed,  is  an  on-line  method 
of  estimating  a  real  rational  transfer  function.  The  second  method  discussed  is 
matching  pursuits  (MP),  a  wavelet  based  real  rational  transfer  function  approx¬ 
imation  algorithm.  Both  methods  are  implemented  using  the  AC-100. 
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5.1  Recursive  Least  Squares 

Recursive  least  squares  estimation  (RLS)  is  an  on-line  method  that  can  be  used 
to  generate  a  mathematical  model  for  any  stable  single  input,  single  output  linear 
time  invariant  plant.  As  the  name  suggests,  the  model  error  will  be  minimized 
in  the  sense  of  least  squares.  If  y(t)  represents  the  plant  output  at  time  t  and 
y(t)  represents  the  model  output  at  time  t,  then  the  quantity 

E(t)  =  [  (y(°)  -  y(°))2do-  (5.1) 

Jo 

will  be  minimized  for  alH  >  0. 

To  implement  RLS,  an  initial  guess  of  a  model  for  the  plant  is  made.  The 
output  of  the  model  is  then  calculated  based  on  a  known  input  and  compared 
to  the  actual  plant  output  to  determine  the  error.  The  parameters  of  the  model 
are  then  adjusted  according  to  error.  The  process  is  repeated  until  the  model 
output  suitably  matches  the  plant  output.  A  more  detailed  description  of  the 
above  process  follows. 

5.1.1  The  Model  Structure 

Since  the  RLS  algorithm  is  usually  implemented  using  a  computer,  it  is  natural  to 
model  the  plant  as  a  discrete  time  system  using  a  z-transform.  The  z-transform 
of  the  output  of  the  model  can  be  written  as 

Y(z)  =  T(z)U(z)  (5.2) 

where 

T(z)  =  +  +  If+j.  (5.3) 

'  zn  +  aizn_1  +  . . .  +  an_iz  +  an 
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and  U(z)  is  the  ^-transform  of  the  model  input.  The  model  parameters  a\,. . .  ,an 
and  b\, ...  ,bn  are  real  and  the  integer  n  is  the  order  of  the  model. 

To  choose  an  initial  guess  for  the  model,  one  must  first  determine  the  value 
of  n.  If  the  physical  properties  of  the  plant  are  well  understood,  there  is  usually 
an  obvious  choice  for  n.  In  some  cases,  however,  the  designer  is  forced  to  make 
a  ” reasonable”  guess  at  n  which  is  then  adjusted  by  trial  and  error  over  several 
repetitions  of  the  entire  RLS  process.  Once  n  is  chosen,  then  the  initial  guess 
for  the  model  is  obtained  by  setting  the  parameters  a^, ...  ,an  and  bi,...,bn  to 
zero. 


5.1.2  Calculating  the  Error 

The  first  step  in  calculating  the  model  error  is  to  calculate  the  model  output. 
Recall  that  for  the  system  described  by  Equations  5.2  and  5.3,  the  current  value 
of  the  system  output  is  given  by 

y(k)  =  -(aiy(k  -  1)  +  a2y(k  -  2)  +  . . .  +  any(k  -  n))  (5.4) 

+biu(k  -  1)  +  b2u{k  -  2)  +  . . .  +  bnu(k  -  n)  (5.5) 

where  at  and  6*  for  i  =  1, 2, . . . ,  n  are  the  unknown  system  parameters.  Hence, 
based  on  the  known  plant  input  and  the  measured  plant  output,  the  model 
output  is  given  by 

y(k)  =  ~(aiy(k-  1) +ci2y(k  -  2)  +  . . . +  any(k  -  n))  (5.6) 

+biu(k  —  1)  +  b2u(k  —  2)  +  . . .  +  bnu(k  —  n)  (5.7) 

where  fij  and  bi  for  i  =  1,2,  ...,n  are  the  estimated  model  parameters.  The 
model  error  is  then 

e(k)  =  y(k)  -  y(k).  (5.8) 


44 


5.1.3  Updating  the  Model  Parameters 

There  are  many  algorithms  available  to  update  the  model  parameters  so  that 
they  will  converge  to  the  solution  of  the  least  squares  problem  [1]  [20].  Here  the 
projection  algorithm  presented  by  K.J.  Astrom  and  B.  Wittenmark  [1]  is  used 
due  to  the  simplicity  of  the  required  calculations. 

First,  some  notation  is  necessary.  Define 

ai(k) 

an(k) 

h(k) 

bn(k) 

and  define 

-y(k  -  1) 

-y(k  -  n ) 
u(k  —  1) 

u(k  —  n ) 

Note  that  this  notation  can  be  used  to  write  the  model  output  as 

y(k)  =  ipT(k)e(k).  (5.11) 

Now  the  parameter  update  law  given  by  the  projection  algorithm  is 

**>-**  —  l)  +  a  +  ^W(*-D  (5'12) 

where  a  >  0  and  0  <  7  <  2. 
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5.1.4  Convergence  of  Model  Parameters 

A  natural  question  which  arises  at  this  point  is  as  follows:  Under  what  conditions 
will  the  projection  algorithm  cause  the  model  parameters  to  converge  to  the 
solution  of  the  least  squares  problem?  It  turns  out  that  the  model  parameters  will 
converge  provided  that  the  input  signal  satisfies  a  condition  known  as  persistant 
excitation.  This  notion  is  formally  developed  below. 

Definition  5.1  A  square  summable  discrete  time  signal  u  is  said  to  be  persis- 

tantly  exciting  of  order  n  if 

t  \2 

yt  ( a0u(k  —  (n  —  1))  +  a\u{k  —  (n  —  2))  +  . . .  +  an-\u(k ))  1  >  0 

fc=i  / 

(5.13) 

for  all  a0, . . . ,  an-i  such  that  ai  ^  0  for  at  least  one  i  G  {0, . . . ,  n  —  1}. 

In  other  words,  a  signal  u  which  is  persistantly  exciting  of  order  n  cannot  be 
filtered  to  0  by  any  finite  impulse  response  (FIR)  filter  of  order  n—  1  or  lower. 
This  leads  to  the  following  theorem,  which  serves  as  a  sufficient  condition  for 
model  parameter  convergence. 

Theorem  5.1  ([3])  Suppose  RLS  with  the  projection  algorithm  is  used  to  iden¬ 
tify  an  nth  order  plant  using  the  model  given  in  equation  5.3.  The  model  param¬ 
eters  will  converge  to  the  solution  of  the  least  squares  problem  provided  that  u  is 
persistantly  exciting  of  order  2 n. 

This  theorem  is  made  more  useful  with  the  following  facts. 

Fact  5.1  ([1])  A  signal  u  that  is  the  sum  of  k  sinusoids  is  persistently  exciting 
of  order  2k. 
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Figure  5.1:  Block  diagram  of  Recursive  Least  Squares  estimation 

Fact  5.2  ([1])  A  signal  u  that  is  an  independant  identically  distributed  (iid) 
process  is  persistantly  exciting  of  all  orders. 

In  order  to  identify  an  nth  order  plant,  an  input  signal  which  is  persistantly 
exciting  of  order  2 n  is  required.  Either  an  input  signal  which  consists  of  the  sum 
of  n  sinusoids  or  an  input  signal  consisting  of  an  iid  process  will  guarantee  model 
parameter  convergence. 

The  block  diagram  in  Figure  5.1  provides  a  graphical  description  of  the  RLS 
process. 

5.1.5  Example:  Identification  of  a  DC  Motor 

Here  RLS  with  the  projection  algorithm  is  used  to  estimate  the  model  of  a  DC 
motor.  The  set  up  used  for  this  identification  experiment  is  shown  in  Figure  5.2. 
Using  the  power  amp  input  voltage  as  the  system  input  u  and  the  tachometer 
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Figure  5.2:  Experimental  set  up  of  DC  motor  for  RLS  identification 


output  voltage  as  the  system  output  y,  the  system  is  well  modeled  by  the  transfer 
function 


T(z)  = 


z  +  a 


(5.14) 


for  some  real  a  and  b  [26].  Employing  the  notation  of  Subsection  5.1.3, 


£(*)  = 


a(k ) 

m 


(5.15) 


and 


<p(k )  = 


-y{k  -  1) 
u(k  —  1) 

Hence  the  update  law  given  by  Equation  5.12  can  be  written  as 


(5.16) 


a(k)  =  +  ki^T)e{k~1)  <5'17) 

-  l»-1>b^Mw-D,(t~1)'  (5'18) 

These  equations  are  easily  implemented  on  a  computer  using  the  AC-100.  The 
motor  system  is  modeled  as  a  discrete  time  system  sampled  at  100  Hz  using 
zero  order  hold.  The  input  to  the  power  amp  u(k)  is  a  2  Hz  sine  wave  with  an 
amplitude  of  1  volt.  It  is  also  sampled  at  a  rate  of  100  Hz.  Note  that  a  sine 
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Figure  5.3:  Parameters  estimates  of  DC  motor  identification 


wave  is  persistantly  exciting  up  to  order  2,  hence  it  is  sufficient  to  guarantee 
convergence  of  the  first  order  model. 

The  results  of  the  experiment  with  7  =  a  =  1  are  plotted  in  Figure  5.3  and 
Figure  5.4.  Figure  5.3  shows  how  the  estimated  parameters  a  and  b  behave  over 
time.  As  shown  in  the  plot,  a  converges  to  —0.854  and  b  converges  to  —0.059. 
Hence,  the  model  estimate  is 


T(z) 


-0.059 
z-  0.854' 


(5.19) 


Figure  5.4  shows  the  step  response  of  this  estimated  model  along  with  the  mea¬ 
sured  step  response  of  the  motor.  The  two  match  very  well. 
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Figure  5.4:  Step  response  of  DC  motor  and  estimated  model 

5.2  Identification  Using  Wavelets 

Here  matching  pursuits  (MP),  a  wavelet  based  real  rational  transfer  function  fit¬ 
ting  algorithm,  is  used  to  perform  system  identification.  The  matching  pursuits 
algorithm  was  developed  by  S.  Mallat  and  Z.  Zhang  [21].  Additional  work  on  the 
algorithm  was  done  by  Y.C.  Pati,  R.  Rezaiifar,  P.S.  Krishnaprasad,  and  W.P. 
Dayawansa  [24].  This  work  was  then  implemented  in  C  code  by  Rezaiifar  [28]. 
The  use  of  the  matching  pursuits  software  has  been  integrated  into  a  seamless 
system  identification  package  using  the  AC-100  system.  This  is  described  below. 


5.2.1  Using  the  Matching  Pursuits  Software 

The  MP  algoritm  produces  a  real  rational  transfer  function  model  of  a  given 
system  from  the  its  experimentally  determined  complex  frequency  response.  The 
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algorithm  attempts  to  match  the  measured  frequency  response  using  a  linear 
combination  of  a  real  rational  analyzing  wavelet  and  translations  and  dilations 
of  the  mother  wavelet.  The  analyzing  wavelet  (or  mother  wavelet)  [23]  used  by 
Rezaiifar’s  code  is 

*(s)  =  (s  +  7)2  +  e2‘  (5'20) 

A  wavelet  which  has  been  translated  and  dilated  is  then  given  by 

=  a™/2'H(a™s  -  inb0)  (5.21) 

where  ao  is  the  dilation  step  size,  m  is  the  dilation  level,  bQ  is  the  translation 
step  size,  and  n  is  the  translation  level  [28].  The  parameters  a0,  b0, 7,  and  £  must 
be  chosen  wisely  so  that  the  algorithm  matches  the  plant  closely  in  the  desired 
region  of  the  frequency  domain.  Likewise,  the  user  must  choose  the  maximum 
number  of  translations  ( nmax )  as  well  as  the  maximum  and  minimum  dilation 
levels  (mmax  and  mmin,  respectively). 

The  procedure  required  to  use  the  MP  software  is  as  follows: 

Step  1:  Gather  input/output  data  from  plant  to  be  identified. 

Step  2:  Calculate  frequency  response  of  plant  from  input/output 
data. 

Step  3:  Choose  ao,  b0, 7,  £,  nmax,  mmax  and  mmin  based  on  the  fre¬ 
quency  response  of  the  plant. 

Step  4:  Run  matching  pursuits  software. 

5.2.2  Example:  Flexible  Beam 

Here  the  system  to  be  identified  is  the  fixed  flexible  aluminum  beam  with  a  PZT 
sensor  and  PZT  actuator  as  described  in  Section  6.1.  PZT  #1  is  used  as  an 
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Figure  5.5:  Flexible  frequency  response 

actuator  and  PZT  #2  is  used  as  a  sensor.  The  block  diagram  of  the  experimental 
set-up  is  shown  in  Figure  6.5.  The  input  voltage  to  the  power  amplifier  is  defined 
to  be  the  system  input  and  the  output  voltage  of  the  inverting  amplifier  is  defined 
to  be  the  system  output. 

The  input  to  the  beam  is  chosen  to  be  the  output  of  a  uniformly  distributed 
random  number  generator  with  maximum  value  1  and  minimum  value  -1.  The 
input  is  updated  every  0.01  seconds  with  a  zero  order  hold  between  updates. 
The  PZT  voltage  is  sampled  every  0.01  seconds  with  a  zero  order  hold  between 
samples.  The  values  of  the  system  input  and  output  are  stored  over  a  period  of 
60  seconds.  The  data  is  then  processed  to  generate  the  frequency  response  of 
the  system  ranging  from  0.1  Hz  to  50  Hz.  This  frequency  response  is  plotted  in 
Figure  5.5. 
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Now  it  is  up  to  the  designer  to  choose  the  MP  parameters.  The  resonances 
of  the  flexible  beam  cause  the  frequency  response  to  be  well  localized  in  the 
frequency  domain.  Since  most  of  the  vibrational  energy  of  the  beam  is  contained 
in  the  first  few  resonances,  the  rest  of  the  frequency  response  is  of  little  interest. 
In  this  example,  the  frequency  range  of  interest  lies  from  .1  Hz  to  20  Hz.  Hence, 
the  MP  parameters  are  chosen  so  that  only  wavelets  localized  to  within  this 
frequency  range  are  used.  This  ensures  a  good  match  within  the  desired  range 
while  keeping  the  order  of  the  generated  model  to  a  minimum.  The  frequency 
response  of  an  5th  order  model  found  using  MP  is  shown  along  with  the  measured 
frequency  response  in  Figure  5.5.  As  a  point  of  comparison,  RLS  performed  on 
the  same  system  requires  a  14th  order  model  to  achieve  a  similar  match  over  the 
desired  frequency  range. 

5.2.3  Conclusion 

Both  recursive  least  squares  and  matching  pursuits  provide  methods  of  quickly 
determining  an  accurate  model  for  SISO  linear  systems.  RLS  has  the  advantage 
that  it  is  an  on-line  process  and  it  is  extremely  easy  to  use.  The  user  needs 
to  know  little  more  than  the  order  of  the  system  to  be  modeled  in  order  to 
successfully  employ  RLS.  These  two  facts  make  RLS  useful  for  adaptive  methods 
such  as  the  self  tuning  regulator  [1].  Matching  pursuits,  on  the  other  hand,  is 
more  difficult  to  use.  In  order  to  successfully  implement  MP  the  user  must  first 
experimentally  determine  the  system’s  frequency  response.  Additionally,  MP 
has  several  parameters  which  must  be  intelligently  chosen  by  the  user  in  order 
to  obtain  a  good  model.  There  is  however  a  reward  for  this  extra  effort.  Once 
the  parameters  are  correctly  chosen  MP  provides  an  accurate  model  of  much 
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lower  order  than  RLS.  In  addition  to  system  identification,  MP  can  be  used  to 
reduce  the  order  of  existing  models,  making  complex  models  more  manageable. 
Hence,  as  is  common  in  engineering,  the  designer  must  take  these  factors  into 
consideration  and  choose  which  method  of  system  identification  is  best  to  use 
for  a  given  application. 

Both  methods  have  been  integrated  into  seamless,  easy  to  use  sytems  in  the 
Intelligent  Servosystems  Laboratory  using  the  AC- 100.  Any  stable  linear  plant 
can  now  be  quickly  identified  with  a  relatively  small  amount  of  effort. 
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Chapter  6 


Fixed  Flexible  Beam  Experiment 


Much  work  has  been  done  in  recent  years  concerning  vibration  damping  in  a 
flexible  beam  using  piezo-electric  ceramic  (PZT)  actuators  and  sensors  [8]  [6]  [12] 
[27].  However,  very  few  have  directly  addressed  the  issue  of  control  constraints. 
The  voltage  applied  to  a  PZT  actuator  is  limited  by  the  PZT  breakdown  voltage 
as  well  as  potential  safety  concerns.  It  is  desirable  to  obtain  the  maximum 
possible  control  effort  without  exceeding  this  voltage  limit.  One  way  to  do  this 
is  to  use  the  constrained  control  feedback  laws  developed  in  Chapter  3.  This 
chapter  will  discuss  the  use  of  the  constrained  controller  presented  by  Gutman 
and  Hagander  [13]  and  discussed  here  in  Section  3.2.2.  The  performance  of  the 
Gutman-Hagander  (GH)  controller  is  then  compared  to  the  performance  of  two 
popular  controllers  in  frequent  use  which  ignore  the  control  constraints,  the  linear 
quadratic  regulator  (LQR)  and  the  positive  position  feedback  (PPF)  controller 
[9], 
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6.1  Experimental  Set  Up 

The  beam  consists  of  a  rectangular  piece  of  aluminum  30  inches  long,  1  inch  wide 
and  0.125  inches  thick.  One  end  of  the  beam  is  mounted  into  a  solid  aluminum 
vise,  which  is  in  turn  mounted  to  a  workbench.  The  beam  is  mounted  in  the  vise 
so  that  both  longest  and  shortest  edges  are  parallel  to  the  ground.  The  distance 
from  the  tip  of  the  beam  to  the  edge  of  the  vise  is  26  inches.  This  is  shown 
in  Figure  6.1.  Five  PZT  pairs  are  mounted  on  the  beam,  each  of  them  can  be 
used  either  as  a  sensor  or  an  actuator.  More  information  about  the  PZT  pairs 
is  provided  in  Section  6.1.1.  The  PZT  pairs  are  distributed  along  the  beam  as 
shown  in  Figure  6.1  and  are  numbered  1-5,  with  pair  #1  being  closest  to  the 
vise.  An  accelerometer  (Sundstrand  Data  Control,  Inc.  model  2180)  is  mounted 
at  the  tip  of  the  beam. 

For  this  experiment,  only  PZT  pair  #1  and  #2  will  be  used.  Pair  #1  will  be 
used  as  the  control  actuator  and  pair  #2  will  be  used  as  a  sensor. 

6.1.1  The  PZT  Pairs 

Each  PZT  pair  consists  of  two  individual  1  inch  by  2  inch  by  0.010  inch  PZT 
crystals  (Matroc  part  number  6/648).  The  crystals  are  mounted  on  opposite 
sides  of  the  beam  and  wired  with  opposite  polarity  so  that  they  work  together. 
If  one  of  the  elements  expands,  its  mate  (on  the  other  side  of  the  beam)  contracts. 
Using  the  PZT’s  in  this  fashion  doubles  the  maximum  possible  control  authority 
and  ensures  that  a  bending  moment  is  applied  to  the  beam  symmetrically. 

Mounting  the  PZT’s  onto  the  beam  with  consistent  results  turns  out  to  be 
somewhat  of  a  difficult  problem.  The  most  straightforward  method  of  bonding  a 
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Figure  6.1:  Flexible  beam  diagram  (not  to  scale) 
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PZT  to  the  beam  is  to  simply  glue  it  onto  the  beam  flat  using  a  strain  gauge  glue 
such  as  M-Line’s  M-200  epoxy.  This  method  presents  some  complications.  First, 
the  mechanical  coupling  between  the  PZT  and  beam  is  inconsistent  from  trial  to 
trial.  Electrical  coupling  problems  also  arise.  For  most  applications  it  is  desirable 
to  have  one  side  of  the  PZT  electrically  connected  to  the  beam.  A  conductive 
epoxy  might  seem  to  solve  this  problem,  but  commercially  available  conductive 
epoxies  do  not  bond  nearly  as  well  as  their  non-conductive  counterparts.  Also, 
conductive  epoxy  can  seep  around  one  of  the  edges  of  the  PZT  and  short  the  two 
sides  together,  making  the  PZT  useless.  Non-conductive  epoxies  bond  well  and 
present  no  potential  of  shorting  the  PZT,  but  the  electrical  connection  between 
the  PZT  and  the  beam  is  hard  to  guarantee.  In  addition,  some  interesting 
PZT  control  techniques  (such  as  Dosch,  Inman  and  Garcia’s  self-sensing  PZT 
actuators  [8])  require  that  both  sides  of  the  PZT  be  electrically  isolated  from  the 
beam.  So  it  would  be  nice  to  be  able  to  connect  and  disconnect  the  electrical 
connection  at  will.  Finally,  placing  the  PZT’s  accurately  on  the  beam  can  be 
difficult.  The  epoxy  cures  almost  immediately,  so  the  PZT  will  be  bonded  to  the 
beam  wherever  it  first  makes  contact.  Hence,  the  PZT  must  be  placed  accurately 
on  the  first  try,  a  difficult  task  for  even  the  most  steady-handed  engineer. 

All  of  these  problems  are  solved  by  the  mounting  scheme  depicted  in  Figure 
6.2.  The  glue  used  is  M-Line’s  M-200  epoxy,  which  is  non-conductive.  Since  only 
the  ends  of  the  PZT  are  close  to  the  beam,  only  the  ends  will  become  bonded. 
This  provides  a  consistent,  easily  repeatable  mechanical  coupling  from  beam  to 
PZT.  Another  advantage  of  the  small  bonding  area  between  the  PZT  and  the 
beam  is  that  it  is  easy  to  ensure  that  the  epoxy  layer  will  electrically  insulate 
the  PZT  from  the  beam.  Sliding  a  coiled  piece  of  wire  in  the  gap  between  PZT 
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Figure  6.2:  PZT  mounting  scheme 

and  beam  will  provide  an  electrical  connection  if  one  is  desired.  If  no  connection 
is  desired,  the  coil  can  be  removed.  Finally,  the  top  of  the  opening  is  machined 
to  fit  the  PZT  precisely,  making  it  easy  to  place  the  PZT  in  the  proper  position 
accurately. 

6.1.2  Electrical  Description 

The  control  signal  is  generated  by  AC-100  and  is  provided  to  the  system  as  an 
analog  voltage  via  one  of  the  AC- 100’s  DAC  outputs.  The  DAC  output  is  fed  into 
the  input  of  a  low  pass  filter  with  a  cut-off  frequency  of  200  Hz  and  a  DC  gain 
of  0.61  V/V.  The  schematic  for  this  filter  is  shown  in  Figure  6.3.  The  purpose 
of  the  filter  is  to  remove  the  sharp  transitions  (steps)  in  the  DAC  waveform 
while  preserving  the  control  intent  contained  in  the  low  frequency  components 
of  the  signal.  This  is  needed  since  the  PZT  does  not  respond  well  to  the  sharp 
transitions  of  the  DAC.  The  filter  output  is  then  fed  into  a  power  amplifier  with 
a  gain  of  36  V/V.  The  schematic  for  the  power  amplifier  is  given  in  Figure  6.4. 
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Figure  6.3:  Low  pass  filter  schematic 

The  output  of  the  power  amplifier  is  then  fed  into  one  side  of  PZT  pair  #1.  The 
other  side  of  PZT  pair  #1  is  connected  to  the  beam,  which  is  grounded. 

PZT  pair  #2  is  used  as  a  sensor.  One  end  of  the  pair  is  connected  to  the 
beam  (ground)  and  the  other  end  is  connected  to  a  TL074  op  amp  configured  as 
an  inverting  amplifier  with  a  gain  of  0.21.  This  attenuating  amplifier  is  necessary 
so  that  the  signal  going  into  the  computer  does  not  exceed  the  +/-  5  volt  range 
of  the  ADC.  A  block  diagram  of  the  entire  set  up  is  given  in  Figure  6.5. 


6.2  Modeling  the  System 

An  accurate  model  of  the  flexible  beam  system  is  required  in  order  to  implement 
the  design  algorithms  mentioned  in  the  beginning  of  this  chapter.  The  model  is 
also  useful  for  simulations.  Additionally,  a  physical  model  can  provide  insight 
which  can  lead  to  a  thorough  understanding  of  how  the  system  operates.  Here,  a 
model  of  the  flexible  beam  derived  from  the  physical  properties  of  the  system  is 
considered.  The  properties  of  this  model  are  discussed  and  then  compared  with 
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Figure  6.4:  Power  amplifier  schematic 
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Figure  6.5:  Block  diagram  of  experimental  set  up 
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the  experimental  model  found  using  wavelets  in  Section  5.2.2. 

6.2.1  Finite  Element  Model 

The  dynamics  of  a  flexible  cantilever  beam  are  inherently  infinite  dimensional. 
An  infinite  dimensional  model  is  not  useful  for  the  purposes  of  this  problem, 
hence  it  is  necessary  to  approximate  the  beam  with  a  finite  dimensional  system. 
One  popular  method  of  doing  this  is  to  approximate  the  beam  as  a  finite  number 
of  rigid  bodies  connected  by  rotary  joints  with  torsional  springs  as  depicted 
in  Figure  6.6.  This  is  known  as  the  Galerkin  model  [2],  The  Euler-Lagrange 
method  can  be  used  to  generate  finite  dimensional  nonlinear  equations  of  motion 
for  the  finite  element  model.  Since  the  vibrations  in  the  flexible  beam  consist 
of  relatively  small  displacements  the  nonlinear  model  can  be  linearized  about 
Qk  =  §k  =  0,k  =  1, N  where  0;  represents  the  slope  of  the  zth  element  and 
N  represents  the  total  number  of  elements  in  the  model.  In  his  M.S.  thesis,  R. 
Rezaiifar  derives  and  linearizes  the  equations  of  motion  [28].  PZT  pair  #1  (the 
actuator)  can  be  used  to  generate  a  moment  about  the  first  joint  of  the  model. 
It  is  assumed  that  this  moment  is  proportional  to  the  voltage  applied  to  the  PZT 
pair.  Likewise,  PZT  pair  #2  (the  sensor)  is  used  to  measure  the  angle  of  the 
first  element.  It  is  assumed  that  the  voltage  generated  by  the  PZT  is  directly 
proportional  to  the  angle. 

This  model  provides  some  good  intuition  about  the  behavior  of  the  flexible 
beam.  Stiffening  the  springs  in  the  model  causes  the  resonances  to  shift  to 
the  right  in  the  frequency  domain.  Reduction  of  the  mass  or  reduction  of  the 
length  of  the  beam  has  the  same  effect.  Distributing  mass  unevenly  along  the 
beam  will  produce  non-symmetrical  mode  shapes  since  the  motion  of  the  heavy 
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Figure  6.6:  3  element  Galerkin  model 

elements  will  dominate  the  motion  of  the  lighter  elements.  These  observations 
are  consistent  with  the  behavior  of  the  actual  beam. 

The  model  also  provides  some  insight  into  ways  to  control  the  system.  Pro¬ 
portional  feedback  will  effectively  increase  the  spring  constant  at  the  first  joint, 
causing  the  beam  to  act  stiffer.  Derivative  or  velocity  feedback  will  add  damping 
to  the  first  joint,  causing  vibrations  in  the  overall  beam  to  become  more  damped. 
These  results  match  previous  experimental  findings  for  an  actual  beam  [8]. 

6.2.2  Experimental  Model 

The  Galerkin  model  is  very  useful  for  understanding  the  flexible  beam,  but  it 
is  not  accurate  enough  to  be  used  for  controller  design.  This  model  relies  on 
too  many  assumptions  (such  as  the  relationship  between  the  actuator  and  joint 
moment)  and  too  many  unmeasureable  parameters  (such  as  the  spring  constants) 
to  be  reliable.  Hence,  an  experimental  model  is  needed. 

The  transfer  function  from  the  input  to  the  filter  connected  to  PZT  pair  # 
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the  the  output  of  PZT  pair  #2  was  found  experimentally  using  the  wavelet  based 
matching  pursuits  algorithm  discussed  in  Section  5.2.2.  The  experimentally  de¬ 
termined  transfer  function  was  found  to  be 


0.1(s  -  1.46)(s  -  7.68)(s  -  75.4)(s2  +  17.6s  +  6.69  x  103) 
(s  +  75.4)(s2  +  0.777s  +  802)(s2  +  6.13s  4-  5.66  x  103) 


This  5th  order  model  will  be  used  to  design  the  controllers  used  in  the  re- 
% 

mainder  of  this  chapter. 


6.3  Controller  Design 

The  three  controllers  to  be  considered  in  this  chapter  are  the  Gutman-Hagander 
controller  (GH) ,  the  linear  quadratic  regulator  (LQR) ,  and  the  positive  position 
feedback  controller  (PPF).  The  GH  and  LQR  design  algorithms  are  based  on 
a  state  space  model,  so  the  real  rational  transfer  function  model  given  in  the 
previous  section  must  be  translated  into  its  equivalent  state  equation  form.  Such 
a  translation  (or  realization)  is  a  standard  classical  control  technique  and  is 
discussed  in  any  good  book  on  linear  control  theory.  Additionally,  both  GH  and 
LQR  require  state  feedback.  Clearly,  the  states  in  the  state  space  model  are 
artificial  and  cannot  be  measured.  Hence  an  observer  will  need  to  be  designed. 
This  section  briefly  describes  the  design  of  the  observer  as  well  as  the  GH,  LQR, 
and  PPF  controllers. 

6.3.1  Observer  Design 

Consider  the  observable  LTI  state  space  system  given  by 

x(t )  =  Ax(t )  +  Bu(t),x(  0)  =  xq 
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v(t)  =  Cx(t) 


(6.2) 


where  x  €  Rn,  u  E  -Rm  and  y  E  Rp.  The  classical  state  space  observer  for  this 
system  is  given  by  Rugh  [29]  as 

x(t)  =  Ax(t)  +  Bu(t)  +  H(y(t)  -  y(t)),x( 0)  =  xQ 

y{t)  =  Cx(t)  (6.3) 

Where  H  is  known  as  the  observer  gain  matrix.  The  error  between  actual  and 
estimated  states,  e(t)  =  x(t)  —  x(t)  then  obeys  the  state  equation 

e(t)  =  (A  -  HC)e(t),  e(0)  =  x0  -  x0.  (6.4) 

Hence,  the  error  of  the  estimated  state  can  be  made  to  go  to  zero  by  choosing  H 
so  that  Equation  6.4  is  exponentially  stable.  This  is  always  possible  since  [A,  C) 
is  observable. 

There  are  many  methods  of  choosing  the  observer  gain  matrix,  H.  Here  H 
is  chosen  using  standard  LQR  methods.  Note  that 

a{A-HC)  =  cr((A  —  HC)t) 

=  g{At  -  CtHt)  (6.5) 

where  a(-)  denotes  the  spectrum.  HT  can  then  be  chosen  so  that  the  cost 
function 

POO 

J(u)=  {\\u(t)\\l  +  oi\\z(t)\\l)dt  (6.6) 

J  0 

is  minimized  for  the  system 

z(t)  =  ATz(t)  +  CTu(t),  z(0)  =  zq.  (6.7) 

The  input  u  which  minimizes  the  cost  function  J(u)  for  the  above  system  is 

u(t)  =  Cnooa:(t)  (6.8) 
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where  is  the  unique  symmetric  positive  definite  solution  to  the  algebraic 
Ricatti  equation  (ARE)  [31] 

AIIoo  +  nocAT  —  IIooC^CTIoo  =  —oil  (6-9) 

where  I  is  the  ( n  x  n)  identity  matrix.  Hence, 

H  =  (cnO0)T.  (6.10) 

The  parameter  a  represents  the  penalty  on  the  observer  error.  This  number 
should  be  chosen  to  be  large  so  that  the  observer  state  will  converge  quickly  to 
the  actual  state.  Here,  a  was  chosen  to  be  104. 

6.3.2  Linear  Quadratic  Regulator 

The  linear  quadratic  regulator  (LQR)  is  a  well  known  algorithm  to  design  a 
linear  state  feedback  law  for  any  linear  time  invariant  system.  The  LQR  method 
can  be  summarized  as  follows:  Let  be  the  unique  symmetric  positive  definite 
solution  the  the  algebraic  Ricatti  equation 

A^Hqo  +  U^A  —  Il00BBTIl00  =  —L  (6.11) 

where  the  ( n  x  n)  matrix  L  is  symmetric  and  positive  semi-definite.  The  linear 
state  feedback  law 

u(t)  =  — 5Tnoox(f)  (6.12) 

will  stabilize  the  system  given  in  Equation  6.2  while  minimizing  the  cost  function 

roc 

J(u)  =  /  ((u(t),u(t))  +  (x(t),  Lx(t)))  dt.  (6.13) 

Jo 

L  =  LT  is  the  state  penalty  matrix.  Since  the  control  objective  is  to  drive 
the  system  output  y(t )  =  Cx(t )  to  zero  as  quickly  as  possible,  we  set  L  =  aCTC 
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so  that  ( x(t ),  Lx(t))  =  a  (y(t),y(t)).  Now  the  LQR  controller  can  be  determined 
by  choosing  one  parameter,  a.  In  simulation,  a  good  value  for  a  was  found  to 
be  0.5.  The  state  feedback  matrix  found  using  the  LQR  algorithm  with  a  =  0.5 
will  hereafter  be  know  as  Klqr ■  Hence,  the  control  with  reference  input  v(t) 
becomes 

u(t)  =  - KLQRx(t )  +  v(t).  (6-14) 

The  system  under  LQR  control  implemented  using  the  state  observer  found 
in  Section  6.3.1  now  becomes 

d  x(t)  A  -BKlqr  x(t)  B 

17  +  «(*) 

dt  x(t)  HC  A-  HC  -  BKlqr  x(t)  B 

x(t) 

y(t)  =  C  [0  -  -  -  0]  •  (6.15) 

J  [  *(* ) . 

6.3.3  Gutman-Hagander  Controller 

The  constrained  input  controller  design  algorithm  proposed  by  P.  Gutman  and 
P.  Hagander  was  described  briefly  in  Section  3.2.2.  A  more  detailed  description 
of  the  algorithm  was  presented  by  R.  Rezaiifar  in  his  M.S.  thesis  [28]  and  in 
the  original  paper  by  Gutman  and  Hagander  [13].  The  algorithm  as  applied  to 
the  flexible  beam  problem  is  described  here.  It  is  assumed  that  the  input  u  is 
constrained  so  that  |u(t)|  <  1  for  all  t  >  0. 

Step  1:  Finding  the  Initial  Condition  Set 

The  first  step  in  the  GH  control  algorithm  is  to  find  the  set  of  possible  initial 
conditions  that  the  plant  can  take,  denoted  as  D.  To  do  this,  the  output  of  the 
beam  (PZT  pair  #2)  was  connected  to  the  observer  designed  in  Section  6.3.1 
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and  the  estimated  states  were  observed  while  the  tip  of  the  beam  was  manually 
deflected  by  one  inch  and  released.  This  is  considered  to  be  the  maximum 
possible  disturbance  input.  The  maximum  absolute  value  attained  by  each  state 
was  recorded.  These  are  denoted  as  x™ax ,  i  =  1, . . . ,  5.  The  set  D  is  then  chosen 
to  be  {z  e  .R5|  \xi\  <  x™ax ,  i  =  1, . . . ,  5}.  It  should  be  noted  that  this  estimate  for 
D  is  somewhat  conservative  since  all  of  the  states  may  not  reach  their  maximum 
value  at  the  same  time.  Still,  it  will  suffice  for  this  problem. 

Step  2:  Find  Stabilizing  Linear  Feedback 

The  second  step  of  the  GH  control  algorithm  is  to  find  a  linear  state  feedback 
matrix  L  which  stabilizes  the  system  while  satisfying  the  input  constraint  for  all 
x  €  D.  The  flexible  beam  is  already  a  stable  system,  so  this  step  is  not  necessary. 
Furthermore,  since  L  is  not  needed,  the  set  E  —  {x  G  R5\  |u|  =  \LTx\  <  1}  is 
equal  to  all  of  Rb. 

Step  3:  Find  P 

Step  3  of  the  GH  algorithm  is  to  find  P  —  PT  >  0  so  that  P  solves  the  Lyapunov 
equation 

PA  +  AtP  =  -Q  (6.16) 

for  some  positive  definite  Q.  Q  can  be  though  of  as  a  design  parameter.  Here, 
Q  is  chosen  to  be  the  5x5  identity  matrix.  Equation  6.16  is  solved  easily  using 
MatrixX. 
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Step  4:  Check  Validity  of  P 


In  order  for  P  to  be  a  valid  choice,  it  must  satisfy  the  inequality 

sup  xTPx  <  min  xTPx.  (6.17) 

x£D  xedE 

Since  E  —  R5  in  this  case,  this  inequality  holds. 

Step  5:  Choose  K 

Now  the  control  law 

u  =  —sat(KBT  Px)  (6.18) 

is  guaranteed  to  stabilize  the  flexible  beam  system  for  all  initial  conditions  x0  € 
D.  K  can  be  any  ( m  x  m)  diagonal  matrix  with  all  of  its  elements  greater  than 
or  equal  to  zero.  Since  the  flexible  beam  is  a  single  input  system  (m  =  1)  K  is 
a  non-negative  scalar. 

To  select  K,  MatrixX  was  used  to  plot  the  locations  of  the  eigenvalues  of  the 
matrix  ( A  —  BKBTP)  for  various  values  of  K.  K  was  then  chosen  to  be  the 
value  for  which  these  eigenvalues  were  pushed  farthest  into  the  left  half  plane. 
This  yielded  K  =  0.002. 

6.3.4  Positive  Position  Feedback 

Here  the  positive  position  feedback  (PPF)  method  presented  by  J.  Fanson  and 
T.  Caughey  [9]  is  used  to  design  a  controller  for  the  flexible  beam.  In  the  PPF 
controller,  the  position  signal  (i.e.  the  voltage  of  PZT  pair  #2)  is  passed  through 
a  bank  of  parallel  second  order  low  pass  filters.  One  filter  is  required  for  each 
frequency  that  is  to  be  controlled.  For  the  flexible  beam,  it  is  only  necessary 
to  control  disturbances  of  the  frequencies  which  correspond  to  the  resonances  of 
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the  beam  since  all  other  frequencies  are  naturally  attenuated.  Each  filter  has  a 
transfer  function  of  the  form 


T(s)  = 


s2  +  2£cocs  +  u2 


(6.19) 


where  uc  is  the  filter’s  cut-off  frequency  in  radians  per  second. 


For  the  flexible  beam,  it  is  desirable  to  control  the  first  two  resonances  of 


the  beam.  These  are  at  24.4  rad/s  and  75.4  rad/s  for  the  first  and  second 
modes,  respectively.  Hence,  two  filters  are  needed.  The  cut-off  frequency  for 
each  filter  is  chosen  to  be  1.1  times  the  frequency  of  the  mode  to  be  controlled. 
The  parameters  k  and  £  for  the  two  filters  are  adjusted  during  a  preliminary 
simulation  step.  The  damping  ratio,  £,  was  chosen  to  be  0.2  for  each  filter.  The 


DC  gains  were  chosen  to  be  0.05  for  the  first  filter  and  0.01  for  the  second.  See 
Figure  6.7  for  a  block  diagram  of  the  system  under  PPF  control. 

It  should  be  noted  that  in  addition  to  filtering  the  amplitude  of  the  position 
signal,  the  PPF  filters  also  shift  the  phase  of  the  cut-off  frequency  by  -90  degrees. 
In  other  words,  PPF  is  equivalent  to  feeding  back  the  velocity  signal  (derivative 
of  position)  of  each  mode  to  be  controlled.  According  to  the  Galerkin  model, 
this  introduces  a  pure  damping  term  at  the  first  link  and  the  system  should 
be  well  damped.  In  fact,  PPF  feeds  back  pure  damping  even  when  the  control 
signal  is  saturated.  Hence,  the  PPF  controller  should  work  well  under  the  input 


constraints. 


6.4  Results 

To  test  these  three  controllers,  the  tip  of  the  beam  was  manually  deflected  by 
exactly  one  inch  and  released.  The  beam  response  was  then  measured.  The 
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Figure  6.7:  Block  diagram  of  PPF  controller 

results  of  this  experiment  are  plotted  for  each  of  the  three  controllers  in  Figures 
6.8,  6.9,  and  6.10.  All  three  controllers  improved  the  ability  of  the  beam  to  reject 
the  disturbance.  The  settling  time  (10%)  of  the  beam  with  no  controller  was 
6.42  seconds.  The  settling  time  with  the  LQR  controller  was  2.89  seconds  while 
both  the  PPF  and  GH  controllers  had  settling  times  of  2.45  seconds. 

The  settling  time  is  defined  to  be  the  latest  time  at  which  the  beam  response 
exceeds  ten  percent  of  its  maximum  value.  Because  of  the  oscillatory  nature 
of  the  beam  response,  comparing  two  responses  using  this  measurement  can  be 
slightly  misleading,  especially  when  the  two  responses  are  very  close.  A  more 
reliable  method  of  comparing  beam  responses  is  to  compare  the  plots  of  the 
responses’  envelopes.  As  Figure  6.11  shows,  the  response  of  the  GH  controlled 
beam  is  slightly  better  than  the  response  of  the  PPF  controlled  beam. 
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Figure  6.8:  Response  of  the  beam  under  LQR  control 


Figure  6.9:  Response  of  the  beam  under  GH  control 
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Figure  6.10:  Response  of  the  beam  under  PPF  control 


Figure  6.11:  Comparison  of  beam  response  envelopes 
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Recall  that  the  control  input  was  constrained  so  that  |u|  <  1.  If  this  con¬ 
straint  is  removed,  the  performance  of  the  controllers  is  significantly  increased. 
The  unconstrained  settling  times  were  1.76  seconds,  1.44  seconds,  and  1.37  sec¬ 
onds  for  the  LQR,  GH,  and  PPF  respectively.  Such  an  improvement  is  expected. 

6.5  Conclusion 

All  three  controllers  improved  the  beams  ability  to  reject  the  disturbance.  The 
LQR  controller  had  the  worst  performance  of  the  three,  but  this  is  to  be  expected 
since  the  LQR  algorithm  is  not  specifically  designed  for  use  as  a  saturating 
controller.  The  GH  and  PPF  controllers  performed  almost  equally  well.  Overall, 
PPF  is  probably  a  better  choice  of  controller  because  it  is  much  simpler  to 
implement  than  the  LQR  and  GH,  both  of  which  require  an  observer. 

This  experiment  provides  an  important  lesson.  Automated  design  algorithms 
such  as  LQR  and  GH  are  nice  to  have,  but  they  are  no  replacement  for  a  thorough 
understanding  of  the  physics  of  the  system  to  be  controlled.  The  PPF  controller, 
which  was  designed  based  on  intuition  provided  by  the  Galerkin  beam  model, 
performed  almost  as  well  as  the  fancier,  automated  methods  and  was  much 
simpler  to  implement. 
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Chapter  7 


Rotating  Flexible  Beam  Experiment 


This  chapter  addresses  the  problem  of  active  damping  of  vibrations  in  a  contin¬ 
uously  rotating  flexible  beam.  Like  the  fixed  beam  experiment  of  Chapter  6,  an 
aluminum  cantilever  beam  with  PZT  sensors  and  actuators  is  used.  However, 
for  this  experiment  the  beam  is  mounted  to  a  hub  driven  by  a  DC  motor.  This 
creates  one  very  interesting  twist  to  the  fixed  beam  experiment:  the  parameters 
of  the  beam  vary  with  the  motor  rotation  rate.  In  particular,  the  resonant  fre¬ 
quencies  of  the  beam  shift  to  the  right  in  the  frequency  domain  as  the  motor 
velocity  increases.  Hence,  this  experiment  provides  an  interesting  application  for 
the  design  algorithms  of  robust  and  adaptive  control. 

In  this  chapter,  the  experimental  set-up  is  described  in  detail.  A  model  for 
the  beam  is  developed  from  physical  principles  and  compared  to  models  found 
using  the  system  identification  techniques  of  Chapter  5.  Linear  controllers  are 
designed  for  the  system  at  two  separate,  fixed  motor  velocities.  Finally,  these  two 
controllers  are  united  to  create  a  gain  scheduling  controller  capable  of  providing 
active  vibration  damping  to  the  beam  over  a  range  of  slowly  changing  motor 
velocities. 
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7.1  Experimental  Set  Up 


The  beam  is  identical  to  the  beam  described  in  Section  6.1  with  one  major 
difference:  single  PZT  crystals  are  mounted  along  the  beam  on  one  side  only 
as  opposed  to  the  PZT  pairs  mounted  along  both  sides  of  the  fixed  beam.  The 
reasoning  behind  this  is  discussed  at  the  end  of  this  section.  The  PZT’s  are 
mounted  to  the  beam  using  the  mounting  scheme  described  in  Section  6.1. 

The  flexible  arm  apparatus  designed  and  constructed  by  G.H.  Frank  [10] 
was  modified  to  suit  the  needs  of  this  experiment.  Since  the  beam  needs  to 
rotate  continuously,  it  was  necessary  to  add  a  slipring  to  Frank’s  set-up  so  that 
electrical  contact  between  the  PZT’s  and  the  controller  could  be  maintained 
during  operation.  To  facilitate  this,  a  new  hub  was  constructed.  The  new  hub 
extends  approximately  8  inches  upward  from  the  motor  housing,  providing  room 
to  mount  an  8  channel  slipring.  Mounted  to  the  top  of  the  hub  is  a  removable 
circular  platform  with  a  7  inch  diameter.  The  beam  is  clamped  to  the  platform 
with  the  PZT  side  facing  down  such  that  PZT  #1  closest  to  the  hub. 

The  electrical  set-up  is  identical  to  the  set-up  described  for  the  fixed  beam 
(Section  6.1.2)  with  the  exception  that  the  connections  to  the  PZT’s  are  made 
via  the  slipring.  For  the  purposes  of  this  discussion,  the  slipring  will  be  treated 
as  a  perfect  short  circuit  at  all  times. 

Clearly,  at  equilibrium  the  beam  will  bend  downward  due  to  the  force  of 
gravity.  PZT’s  mounted  on  the  top  side  of  the  beam  would  be  extended,  pro¬ 
viding  them  with  a  negative  mechanical  bias.  This  is  not  good  for  the  crystals 
and  causes  them  to  crack  easily.  For  this  reason,  all  of  the  PZT’s  are  mounted 
on  the  bottom  side  of  the  beam  only. 
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7.2  Modeling  the  System 

As  discussed  in  Section  6.2,  an  accurate  model  of  the  flexible  beam  system  is 
useful  for  many  reasons.  Here,  a  model  of  the  flexible  beam  derived  from  the 
physical  properties  of  the  system  is  considered.  The  properties  of  this  model  are 
discussed  and  then  compared  with  models  found  using  experimental  methods. 

7.2.1  Finite  Element  Model 

The  Galerkin  model  discussed  in  Section  6.2.1  can  be  easily  applied  to  this 
problem  with  a  couple  of  modifications.  The  two  major  differences  between  this 
problem  and  that  of  the  fixed  beam  come  from  the  gravitational  and  centrifugal 
forces.  Each  link  in  the  model  will  be  subject  to  a  constant  downward  force 
of  rriig  where  m*  is  the  mass  of  the  ith  link  and  g  is  the  acceleration  due  to 
gravity.  This  accounts  for  the  effect  of  gravity.  Additionally,  each  link  is  subject 
to  a  force  of  urriiXi  in  a  direction  radially  outward  from  the  hub.  Here  u>  is  the 
angular  velocity  of  the  motor  and  Xi  is  the  x  position  of  the  center  of  gravity  of 
the  ith  link.  This  accounts  for  the  centrifugal  force  due  to  rotation.  Since  both 
of  these  forces  are  applied  in  a  constant  direction  with  respect  to  the  beam,  the 
rotating  beam  can  be  modeled  as  a  fixed  beam  with  these  new  forces  in  place. 
A  diagram  of  a  3-link  version  of  this  model  is  shown  in  Figure  7.1. 

The  equations  of  motion  for  this  system  can  be  found  using  the  Euler- 
Lagrange  method.  For  and  n-link  beam 

_  d_  (dE\  _dE_  dU_ 

Tk  Tk+1~dt[dek)  dek  +  ddk  ’ 

where 

6i  =  the  slope  of  the  ith  link, 
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Figure  7.1:  3  element  Galerkin  model  of  continuously  rotating  flexible  beam 

E  =  the  kinetic  energy  of  the  system, 

U  =  the  potential  energy,  and 

Tj  =  the  external  moment  generated  at  the  ith  joint. 

The  kinetic  energy  can  be  expressed  as  a  function  of  the  translational  and 
rotational  velocities  of  each  link.  Specifically, 

E  =  S  +  Vi)  +  £  (7-2) 

*=i  z  i=i  z 

where 

rrii  —  the  mass  of  the  ith  link, 

Ii  =  the  moment  of  inertia  of  the  zth  link  about  its  center  of  mass,  and 
(: Xi ,  yi)  =  the  cartesian  position  of  the  center  of  mass  of  the  zth  link. 
Likewise,  the  potential  energy  can  be  expressed  as  the  sum  of  the  energy 
stored  in  the  springs,  the  displacement  of  the  links  against  gravity,  and  the 
displacement  of  the  links  against  the  centrifugal  force.  Specifically, 

n  ^  n  n 

U  =  T,  ~ki(9i  -  6i- 1)2  +  52 mi9Vi  -  5Z miUx2i,  (7.3) 

i= 1  Z  i= 1  i= 1 
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where 


uj  =  the  angular  velocity  of  the  motor  and 
g  =  the  acceleration  due  to  gravity. 

This  is  identical  to  Rezaiifar’s  formulation  of  the  fixed  beam  model  [28]  with 
the  addition  of  the  gravity  and  centrifugal  force  terms  in  the  potential  energy 
equation. 

Tedious  application  of  the  chain  rule  yields 
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Substituting  Equations  7.4,  7.5,  and  7.6  into  equation  7.1  yields 
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Assuming  the  mass  of  each  link  to  be  evenly  distributed  and  following  a  series 
of  substitutions  similar  to  Rezaiifar  [28]  yields  the  following  expression  for  the 
equations  of  motion  of  the  beam.  Note  that  this  expression  does  not  contain  any 
partial  derivatives. 
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for  fe  =  1, 2, ...  ,n. 

Now  for  the  purpose  of  understanding  the  characteristics  of  the  model,  several 
simplifying  assumptions  are  made.  They  are 
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•  the  number  of  links  is  two  (n  =  2), 

•  the  beam  is  in  a  zero  gravity  environment  (g  =  0), 

•  the  lengths  of  the  two  links  are  equal  (h  =  I2  —  l), 

•  the  masses  of  the  two  links  are  equal  (mi  =  m2  =  m),  and 

•  the  two  spring  constants  are  equal  (hi  =  Jt2  =  k). 

The  equations  of  motion  of  the  simplified  two  link  beam  can  now  be  expressed 
as 


and 
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Finally,  these  equations  can  be  linearized  and  put  into  state-space  form  to 
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Now  the  eigenvalues  of  this  system  can  be  calculated.  They  are 


Al,2  — 
A3, 4  = 
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(7.12) 


Clearly,  as  lo  increases,  the  magnitudes  of  all  four  eigenvalues  also  increase.  Since 
the  eigenvalue  magnitudes  correspond  to  the  resonant  frequencies  of  the  system, 
this  means  that  the  resonances  of  the  system  also  increase  with  co.  Hence,  the 
rotating  flexible  beam  can  be  though  of  as  an  uncertain  linear  system  with  its 
uncertainties  parameterized  by  u>. 

Note  that  the  eigenvalues  also  increase  as  k  increases  and  decrease  as  either 
m  or  l  decrease.  These  facts  concur  with  the  intuition  gained  for  the  fixed  beam 
in  Chapter  6. 


7.2.2  Experimental  Model 

The  model  derived  in  the  previous  section  contains  many  parameters  that  are 
difficult  if  not  impossible  to  measure.  For  this  reason,  it  is  necessary  to  exper¬ 
imentally  determine  a  model  for  the  system.  Clearly,  if  the  motor  velocity  uim 
is  allowed  to  vary,  the  system  cannot  be  modeled  as  being  linear  time  invariant 
(LTI).  It  would  be  nice  to  model  the  system  as  LTI  since  there  are  a  wide  vari¬ 
ety  of  control  tools  and  algorithms  which  address  LTI  systems.  One  method  of 
solving  this  problem  would  be  to  obtain  several  models  of  the  system  at  differ¬ 
ent  fixed  motor  velocities.  Once  the  motor  velocity  is  fixed,  the  system  is  well 
modeled  as  LTI  and  a  controller  for  each  motor  velocity  can  be  designed  using 
existing  techniques.  Then,  when  the  motor  velocity  is  allowed  to  vary  slowly, 
some  sort  of  gain  scheduling  algorithm  can  be  employed  to  choose  the  correct 
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Figure  7.2:  Frequency  response  of  rotating  beam,  com  =  0 

controller  for  the  system  at  any  point  in  time.  This  is  the  strategy  attempted 
here.  Hence,  instead  of  trying  to  find  one  model  to  describe  the  action  of  the 
system  over  all  motor  velocities,  different  models  will  be  found  for  different  fixed 
motor  velocities. 

The  frequency  responses  of  the  system  with  u)m  —  0  and  u>m  —  4  rad/sec  are 
plotted  in  Figures  7.2  and  7.3.  For  simplicity,  only  the  first  mode  of  vibration  will 
be  addressed  here.  From  the  figures,  it  is  clear  that  the  first  resonant  frequency 
of  the  system  increases  as  the  motor  velocity  increases,  as  predicted  by  the 
finite  element  model.  The  beam’s  natural  damping  also  increases  with  motor 
velocity.  The  finite  element  model  does  not  account  for  any  damping  terms  so 
this  behavior  is  not  predicted. 

At  this  point,  the  wavelet  based  matching  pursuits  (Section  5.2)  or  recursive 
least  squares  (Section  5.1)  could  be  used  to  obtain  a  model  for  these  systems. 
However,  since  only  one  resonance  is  being  considered  here  models  are  easily 
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Figure  7.3:  Frequency  response  of  rotating  beam,  u)m  =  4 


obtained  by  hand.  The  model  for  u>m  =  0  is 

0.2s2 


To(»)  = 


s2  +  2  •  0.02  •  2jt  •  3.4s  +  (2jr  •  3.4)2 


(7.13) 


and  the  model  for  =  4  is 


Tt(>) 


0.35s2 

s2  +  2  ■  0.15  •  2?r  ■  4.3s  +  (2tt  •  4.3)2 ' 


(7.14) 


The  frequency  response  of  each  model  is  plotted  with  its  corresponding  ex- 
perimetnally  determined  frequency  response  in  Figures  7.2  and  7.3. 


7.3  Controller  Design 

Here  the  positive  position  feedback  (PPF)  controller  presented  by  J.  Fanson  and 
T.  Caughey  [9]  is  used  to  design  a  controller  for  each  motor  velocity.  Since  only 
one  the  first  mode  is  being  considered,  the  PPF  controller  for  each  motor  velocity 
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will  consist  of  one  second  order  low  pass  filter.  The  PPF  controller  for  wm  =  0 


is 


H0(s)  = 


(3.7*2tt)s 


s2  +  2  •  0.2  •  2tt  •  3.7s  +  (2tt  •  3.7)2 
and  the  PPF  controller  for  wm  —  4  is 


(7.15) 


H4(s)  = 


(4.9  •  2t r)s 


(7.16) 


s2  +  2  •  0.2  •  27T  •  4.9s  +  (27t  •  4.9)2 ' 

The  switching  point  for  the  gain  scheduling  controller  will  be  found  by  trial 
and  error  on  the  actual  system. 


7.4  Results 

To  test  these  controllers,  PZT  #3  will  be  used  to  generate  a  disturbance,  PZT 
#2  will  be  used  as  a  sensor,  and  PZT  #1  will  be  used  as  the  control  actuator. 
A  block  diagram  of  the  experimental  set-up  is  shown  in  Figure  7.4.  Before 
the  controllers  can  be  tested,  however,  some  measure  of  system  performance 
must  be  defined.  This  performance  measure  should  express  the  ability  of  the 
system  to  attenuate  vibrations  of  various  frequencies  at  various  motor  velocities. 
Hence,  the  3  dimensional  plot  of  the  absolute  value  of  the  output  signal  versus 
the  disturbance  signal  frequency  and  motor  velocity  will  provide  a  good  visual 
display  of  controller  performance.  Further,  integrating  this  surface  will  provide  a 
scalar  measure  of  performance  for  the  controller.  Specifically,  disturbance  signals 
will  be  sine  waves  ranging  in  frequency  from  1  to  10  Hz  in  increments  of  1  Hz. 
The  motor  velocities  will  range  from  0  to  4  rad/sec  in  increments  of  1  rad/sec. 
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Figure  7.4:  Block  diagram  of  experimental  set-up 

7.4.1  Performance  at  Fixed  Motor  Velocities 

First,  each  controller  is  tested  at  the  fixed  motor  velocity  for  which  is  was  de¬ 
signed.  These  results  are  plotted  in  Figures  7.5  and  7.6.  The  horizontal  axis 
of  each  plot  represents  the  frequency  in  Hertz  of  the  5  volt  sine  wave  sent  to 
PZT  #3.  The  vertical  axis  represents  the  magnitude  of  the  resulting  signal  at 
the  sensor  PZT  #2  in  decibels.  Both  controllers  reject  the  disturbance  signal 
significantly  around  the  resonance  of  the  system,  but  do  little  away  from  the  res¬ 
onance.  This  makes  sense  since  PZT  actuator  is  relatively  weak  and  the  beam 
naturally  rejects  frequencies  away  from  its  resonances. 

7.4.2  Slowly  Varying  Motor  Velocities 

The  objective  here  is  to  build  one  controller  which  can  control  the  system  well 
at  all  velocities.  The  first  step  in  doing  this  is  to  investigate  the  performance 
of  the  individual  controllers  over  a  variety  of  motor  velocities.  Figure  7.7  shows 
the  response  of  the  uncontrolled  beam  over  a  variety  of  motor  velocities  and 
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Figure  7.5:  Disturbance  response  of  beam  at  u>m  =  0  rad/sec 
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Figure  7.6:  Disturbance  response  of  beam  at  u>m  =  4  rad/sec 
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Figure  7.7:  Disturbance  response  of  beam  using  no  control 

disturbance  frequencies.  Figures  7.8  and  7.9  depict  the  performance  of  the  two 
controllers  over  the  same  variety  of  motor  velocities  and  disturbance  frequencies. 
The  X  axis  represents  the  motor  velocity,  u>m  in  rad/sec,  the  Y  axis  represents 
the  disturbance  frequency  in  Hertz,  and  the  Z  axis  represents  the  corresponding 
magnitude  of  the  sensor  voltage  in  volts.  As  expected,  each  controller  performs 
well  when  operating  near  its  intended  motor  velocity,  but  does  not  perform  well 
away  from  this  velocity.  The  controller  designed  for  com  =  4  is  unstable  at 
com  =  0  and  does  a  poor  job  of  rejecting  disturbance  frequencies  near  3  Hz  at 
low  motor  velocities.  Likewise,  the  controller  designed  for  =  0  does  not 
reject  disturbance  frequencies  near  5  Hz  at  high  motor  velocities.  As  these 
experiments  show,  the  uncontrolled  beam  actually  responds  better  over  a  range 
of  motor  velocities  than  either  of  the  two  controllers. 

Given  these  results,  the  most  straightforward  way  to  build  one  controller  to 
control  the  system  at  all  motor  velocities  is  to  switch  between  the  two  individual 
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Figure  7.8:  Disturbance  response  of  beam  using  controller  Hq(s) 
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Figure  7.9:  Disturbance  response  of  beam  using  controller  i74 (s) 
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Figure  7.10:  Disturbance  response  of  beam  using  gain  scheduling  controller 

controllers  depending  on  the  motor  velocity.  That  is  use  H0(s)  when  um  <  2 
and  use  H^s)  when  uim  >  2.  This  approach  is  a  simple  form  of  gain  scheduling. 
The  performance  of  this  gain  scheduling  controller  is  depicted  in  Figure  7.10. 

To  obtain  a  scalar  performance  measure,  the  surfaces  depicted  in  Figures  7.8, 
7.9,  and  7.10  can  be  integrated.  These  values  turn  out  to  be 

J(mbox  uncontrolled)  —  74.4 
J(H0{s))  =  78.4 

J(H^(s))  =  oo (unstable  at  <Mm  =  0) 

J(gain  sched)  =  66.3.  (7-17) 

7.5  Conclusion 

The  continuously  rotating  flexible  beam  changes  characteristics  as  the  motor 
velocity  increases.  Specifically,  the  resonant  frequencies  of  the  beam  increase 
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with  the  motor  velocity.  This  presents  an  interesting  control  problem.  Here 
standard  linear  control  techniques  have  been  applied  to  control  the  system  at 
fixed  motor  velocities.  Then  a  simple  gain  scheduling  controller  was  devised  to 
switch  between  the  linear  controllers.  For  slowly  varying  motor  velocity,  the  gain 
scheduling  controller  worked  better  over  the  range  of  possible  motor  velocities 
than  any  one  linear  controller,  hence  can  be  called  a  success. 

The  gain  scheduling  is  the  simplest  method  of  adressing  this  problem.  Many 
of  the  tools  that  have  been  developed  recently  in  adaptive  and  robust  control 
can  be  applied  directly  to  this  problem.  This  is  left  for  future  work. 
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Chapter  8 


Impact  of  a  Flexible  Robotic  Arm 


Many  applications  of  modern  robotic  technology  involve  mechanical  interaction 
between  a  robotic  manipulator  and  some  object  in  the  manipulator’s  workspace. 
Naturally,  this  interaction  always  involves  physical  contact  between  the  object 
and  the  manipulator.  In  some  cases,  particularly  those  involving  a  manipulator 
composed  of  flexible  links,  the  collision  between  the  object  and  the  manipulator 
can  excite  an  undesirable  response,  sometimes  leading  to  catastrophic  failure. 
For  this  reason,  a  great  deal  of  effort  has  been  concentrated  on  the  problem  of 
modeling  the  impact  forces  involved  in  collisions  between  flexible  objects  [33], 
[34],  [4],  [19].  Such  models  can  be  used  to  predict  the  behavior  of  the  system 
due  to  impact. 

In  this  chapter,  the  characteristics  of  a  collision  between  a  single  link  flexible 
robotic  arm  and  a  fixed  object  are  investigated.  The  experimental  set  up  is 
described  and  a  model  for  the  impact  is  developed  using  the  Hertz  law  of  impact. 
Finally,  an  open  loop  controller  composed  of  a  neural  network  is  employed  to 
control  the  peak  magnitude  of  the  impact  force  between  the  arm  and  the  fixed 
object. 
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Figure  8.1:  Mounting  of  the  FSR  (force  sensitive  resistor) 

8.1  Experimental  Set  Up 

As  in  Chapter  7,  a  modified  version  of  the  flexible  arm  apparatus  designed  and 
constructed  by  G.H.  Frank  [10]  is  used  for  this  experiment.  The  new  hub  de¬ 
scribed  in  Section  7.1  is  not  actually  necessary  to  this  experiment,  however  it  is 
used  since  it  is  already  in  place.  An  aluminum  beam  measuring  30”  x  2”  x  0.125” 
is  mounted  in  a  vise  centered  on  the  vertical  axis  of  the  hub.  The  beam  is 
mounted  so  that  the  flat  side  of  the  beam  (the  30”  x  2”  side)  is  parallel  to  the 
jaws  of  the  vise  and  the  long  skinny  side  (the  2”  x  0.125”  side)  is  parallel  to  the 
floor  and  26”  stick  out  of  the  vise  on  one  side.  A  force  sensitive  resistor  (FSR)  is 
mounted  on  the  flat  side  of  the  beam  with  as  shown  in  Figure  8.1.  A  photograph 
of  the  entire  set  up  is  shown  in  Figure  8.2. 

The  object  which  the  beam  collides  with  consists  of  a  1”  radius  aluminum 
sphere  mounted  to  an  adjustable  stand.  The  stand  is  placed  so  that  the  sphere 
contacts  the  center  of  the  FSR  when  the  beam  collides  with  the  sphere. 

The  electrical  set  up  is  straight  forward.  The  FSR  is  used  as  part  of  a  voltage 
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Figure  8.2:  Flexible  arm  set-up 
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Figure  8.3:  Electrical  set  up  of  FSR  (force  sensitive  resistor) 

divider,  the  output  of  which  is  connected  to  one  of  the  analog  inputs  of  the  AC- 
100  as  shown  in  Figure  8.3.  The  translation  from  the  divider  voltage  to  its 
corresponding  force  is  accomplished  using  software.  The  motor  control  signal  is 
generated  by  the  AC-100  and  passed  through  a  power  amplifier  to  the  motor. 


8.2  Modeling  the  System 

Here  a  model  of  the  response  of  the  flexible  arm  apparatus  due  to  impact  is 
developed.  First,  the  finite  element  model  of  the  fixed  beam  system  is  briefly 
reviewed.  This  model  is  then  modified  to  accommodate  the  rotating  hub  and  an 
impact  force  at  the  tip  of  the  beam.  Then,  this  model  is  used  in  combination 
with  Hertz  law  of  impact  to  determine  the  impact  force  between  the  moving 
beam  and  a  the  fixed  aluminum  sphere.  Finally,  the  impact  force  predicted  by 
the  model  is  compared  to  experimental  impact  data. 
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8.2.1  The  Finite  Element  Model 

As  discussed  in  Chapters  6  and  7,  one  popular  method  of  modeling  the  flexible 
beam  is  to  approximate  the  beam  as  a  finite  number  of  rigid  bodies  connected 
by  rotary  joints  with  torsional  springs  as  depicted  in  Figure  6.6.  This  is  known 
as  the  Galerkin  model  [2].  The  equations  of  motion  for  Galerkin  model  of  the 
cantilever  beam  derived  using  the  Euler-Lagrange  method  are 

n  i— 1 

Tfc  -  Tfe+i  =  Y  mi  Y  l^l3  (sin(0ft  “  Oj)&j  +  COs(0fc  -  9j)9 j) 

i=k+ 1  j=l 

+  ^  Y  lkh  (sin(0fc  -  +  cos (0k  -  ej)9j) 

1  b'=1 

+  Y  [lkh  (sin(^  -  °i)0i  +  COS(0k  -  0»)0i) 

i=k+ 1  1 

+  —^-Qk  +  h^k  +  kk(Qk  ~  9k-i)  —  kk+i(9k+i  —  9k)  (8.1) 

for  k  =  1, 2, . . .  ,n  where 

•  n—  the  number  of  links, 

•  9i  =  the  slope  of  the  ith  link, 

•  Ti  =  the  external  moment  generated  at  the  ith  joint, 

•  m;  =  the  mass  of  the  ith  link, 

•  I(  =  the  moment  of  inertia  of  the  ith  link  about  its  center 
of  mass, 

•  li  —  the  length  of  the  ith  link,  and 

•  ki  =  the  spring  constant  at  the  ith  joint. 

These  equations  were  derived  by  Rezaiifar  [28].  It  should  also  be  noted  that 
these  equations  are  identical  to  the  equations  of  motion  derived  in  Chapter  7  for 
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the  continuously  rotating  beam  (Equation  7.8)  with  both  the  motor  velocity,  to, 
and  the  acceleration  due  to  gravity,  g,  set  equal  to  zero. 

The  model  given  by  Equation  8.1  can  be  slightly  modified  to  provide  an 
accurate  representation  of  the  flexible  arm  aparatus  with  a  force  applied  to  the 
tip.  In  the  flexible  arm,  the  first  link  of  the  beam  is  attached  via  a  spring  to  the 
hub  of  the  motor.  The  hub  is  free  to  rotate  and  is  subject  to  an  input  torque  r0 
from  the  motor.  This  adds  another  degree  of  freedom  to  the  system,  hence  the 
following  equation  of  motion  must  be  added  to  the  model: 

To  -  Ti  =  I090  -  ki{0i  -  90)  (8.2) 

where  To  is  the  moment  of  inertia  of  the  hub  and  90  is  the  angle  of  the  hub. 
90  =  0  when  the  undeflected  beam  is  in  line  with  the  positive  x  axis. 

A  force  applied  to  the  tip  of  the  beam  generates  a  moment  about  the  nth 
joint  equal  to  Flncos(9n).  Since  the  system  has  already  been  linearized,  it  has 
already  been  assumed  that  9n  is  small  so  the  effective  moment  applied  to  the 
nth  joint  by  the  force  F  can  be  approximated  as  Fln.  Since  there  are  no  PZTs 
on  this  beam,  the  moments  applied  to  all  other  joints  are  zero. 

Finally,  the  y  position  of  the  tip  of  the  beam  will  be  necessary  for  the  Hertz 
analysis.  Simple  trigonometry  yields 

n 

S/tip  =  53  o  +  Oi)  (8.3) 

i=i 

As  stated  before,  it  has  already  been  assumed  that  9i,i  =  1,2 , . . . ,  n  are  small. 
Furthermore,  it  is  assumed  that  the  impact  will  occur  on  the  x  axis,  hence  it 
can  be  assumed  that  90  is  small  for  the  duration  of  the  impact.  Hence,  the  y 
position  of  the  tip  can  be  approximated  as 

2/tip  =  53  Wo  +  #i)-  (8.4) 
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Figure  8.4:  Galerkin  model  of  flexible  arm 


This  completes  the  modifications  necessary  to  the  fixed  flexible  beam  model. 
A  diagram  of  a  2-link  version  of  this  model  is  shown  in  Figure  8.4.  To  summarize, 
the  equations  of  motion  for  the  flexible  arm  subject  to  motor  torque  r0  and  a 
force  F  at  the  tip  are: 


To  —  IoOo  —  k\  {0\  —  9q) 

n  i— 1 

Tfc  -  Tk+ 1  =  Y  TUi  5Z  lklj  (Sin(0*  -  9j)dj  +  COS(0fc  -  0j)0j) 

i=fc+l  j= 1 


^  Y  lklj  (sin(^fc  -  Oj)&j  +  cos(ek  -  0j)0j) 


+  H  ~7T  [lkli  (sin(0fe  “  9i)0i  +  C0S(^  “  6i)8i)] 

i=k+l  * 

+  ^ek  +  ikek 

+  kk(dk  ~  9k- i)  —  kk+i(dk+i  ~  9k) 

2/tip  =  ^}2h{9o  +  9i). 


where  t*  =  0  for  i  =  1, 2, . . . ,  n  —  1  and  rn  =  Fln. 
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In  his  masters  thesis,  Rezaiifar  [28]  developed  a  Mathematica  script  file  called 
EqOfMotion.m  which  is  capable  of  linearizing  the  system  of  equations  listed  in 
Equation  8.1  and  placing  them  in  state  space  form.  This  script  file  is  easily 
modified  to  translate  the  equations  of  motion  for  the  flexible  arm  with  tip  force. 
The  state  space  equation  for  the  system  can  then  be  written  as 


where 


and 


x  =  Ax  +  Bu, 


2/tip  =  Cx 


0o 

0o 


0n 

On 


(8.6) 


(8.7) 


(8.8) 


8.2.2  Hertz  Law  of  Impact 


Hertz  provided  the  first  satisfactory  analysis  of  the  stresses  at  the  contact  of  two 
elastic  bodies  by  posing  the  problem  as  a  similar  problem  in  elastostatics  [33]. 
Hertz  law  of  impact  is 

a{t)  =  K  [F(t)]2/3  (8.9) 
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where  a(t )  is  the  relative  displacement  between  the  bodies  at  time  t ,  F(t)  is  the 
impact  force  between  the  bodies,  and  K  is  the  Hertz  constant  [32] 

-2/3 


K 


'4 

.3 


Q  i  +  Q2V  A  +  B  J 


(8.10) 


The  constants  q,A,B,Q  1,  and  Q2  depend  on  the  local  geometry  of  the  region 
of  impact.  In  this  case,  a  plane  (the  beam)  is  colliding  with  a  sphere  and  the 
constants  become 


q  =  7T2/3 

A  =  2 
B  =  m 

Qi  =  (1  -  hD/Eitt 

Q2  =  (l-fj,l)/E2K  (8.11) 

where  Ri  is  the  radius  of  the  sphere,  Hi,  fj,2  is  the  Poisson  ratio  of  the  sphere 
and  the  beam,  respectively,  and  E\,  E2  is  the  Young’s  modulus  of  the  sphere 
and  the  beam,  respectively  [17]. 

Figure  8.5  provides  a  sketch  of  the  relative  displacement  between  the  beam 
the  the  sphere  during  impact.  Since  the  sphere  is  fixed,  the  relative  displace¬ 
ment  a(t)  =  Naturally,  y^jp  is  dependent  on  the  unknown  impact 

force,  F.  Using  Hertz  law  of  impact  yields  the  relationship  —y(t)  —  K  [F(t)]2^3. 
Substituting  the  solution  of  Equation  8.6  results  in  the  integral  equation 


c 

eAtx(0)  +  eA{t~a)B 

T0  (ff) 

da 

=  K[F(t)]2/3. 

(8.12) 

Jo 

F(a) 

Hence,  if  the  state  of  the  beam  at  the  moment  just  before  impact  and  the 
motor  input  To  are  known,  then  the  model  derived  in  the  previous  section  can 
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Figure  8.5:  Relative  displacement  between  beam  and  sphere  during  impact 

be  used  in  an  iterative  approach  to  numerically  solve  for  the  impact  force  F  as 
a  function  of  time.  The  algorithm  to  do  this  is  as  follows: 

Step  1:  Choose  a  suitably  small  time  increment  T  and  a  suitably 
large  final  time  tf. 

Step  2:  Let  F0(t)  =  0  for  all  time  steps  from  0  to  tf. 

Step  3:  Let  i  =  1. 

Step  4:  Solve  Equation  8.6  numerically  using  F(t)  =  F^-i)(t)  to 
obtain  yi(t)  for  all  time  steps  from  0  to  tf. 

Step  5:  Let  Fi(t )  —  (-yi(t) / K)3/2 . 

Step  6:  fncrement  i  and  repeat  step  4  until  Fi(t )  is  sufficiently 
close  to  F(j_i)(t). 

This  method  is  known  as  the  method  of  Picard  iteration.  If  it  converges,  it  will 
converge  to  the  solution  of  Equation  8.12,  which  is  the  impact  force  between  the 
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beam  and  the  sphere. 


8.2.3  Computing  the  Impact  Force  Numerically 

The  above  algorithm  can  be  implemented  using  MATLAB.  First  it  is  necessary 
to  define  the  model  parameters.  These  are  [22] 

•  l  =  0.6604  m  (length  of  beam) 

•  p  =  0.438  kg/m  (beam  mass  per  unit  length) 

•  El  =  9.62  Nm  (Youngs  modulus  x  moment  of  cross  sec¬ 
tion  ) 

•  Iq  =  1.89  x  10~3  kg/m 3  (moment  of  inertia  of  hub) 

•  Ei  =  E2  =  79  x  109  Pa  (Young’s  modulus  of  beam  and 
sphere) 

•  Pi  —  P2  =  0.33  (Poisson  ratio  of  beam  and  sphere) 

•  R\  =  0.0254  m  ( radius  of  sphere) 

The  procedure  for  performing  the  Picard  iterations  is  straight  forward.  First 
the  modified  EqOf Motion. mis  used  to  obtain  a  state  space  model  for  the  rotating 
beam.  At  the  moment  of  impact,  the  beam  is  relaxed,  the  motor  hub  is  at  zero, 
and  the  motor  hub  is  moving  in  a  negative  direction.  This  corresponds  to  the 
initial  condition 

0i(O)  =  0,  i  =  0, 1, . . .  ,n, 

6^(0)  =  0,  *  =  l,2,...,n, 

0o(O)  =  (8.13) 
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where  com  is  the  angular  velocity  of  the  hub  at  the  moment  of  impact.  Using  this 
information,  the  above  algorithm  can  be  implemented  using  MATLAB.  Specif¬ 
ically,  the  script  file  picard.m  was  created  for  this  purpose.  For  this  case,  the 
algorithm  converges.  The  solution  after  five  iterations  is  sufficiently  accurate 
for  the  purposes  of  this  discussion.  A  plot  showing  the  numerically  solved  im¬ 
pact  forces  for  various  hub  velocities  is  shown  in  Figure  8.6.  A  plot  showing  the 
experimentally  measured  impact  forces  for  the  same  hub  velocities  is  shown  in 
Figure  8.7. 

As  the  figures  show,  the  impact  force  predicted  from  the  model  has  a  much 
greater  peak  magnitude  and  a  much  shorter  duration  than  the  experimentally 
measured  impact  forces.  Many  factors  could  cause  this  error.  First,  the  model 
assumes  the  impact  occurs  between  an  aluminum  beam  and  an  aluminum  sphere. 
In  the  experiment,  an  FSR  is  actually  placed  between  the  colliding  bodies.  The 
FSR  is  made  up  of  material  which  is  much  softer  than  aluminum,  so  this  is 
probably  a  large  source  of  error  in  the  model.  Another  possible  source  of  error 
lies  in  the  assumption  that  the  aluminum  sphere  is  fixed.  In  fact,  the  aluminum 
sphere  was  mounted  to  a  stand.  The  stand  was  as  solid  as  such  a  device  can  be 
expected  to  be,  but  still  the  forces  during  impact  are  capable  of  exciting  vibra¬ 
tions  in  the  stand.  This  phenomenon  is  not  considered  in  the  model.  Finally, 
since  the  duration  of  the  impact  is  so  short,  the  time  response  of  the  electrical 
circuit  probably  distorts  the  impact  signal. 

In  spite  of  these  problems,  the  model  still  predicts  the  general  behavior  of 
the  impact  reasonably  well.  The  basic  shape  of  the  impact  curve  is  the  same. 
Additionally,  a  smaller  motor  velocity  results  in  an  impact  force  of  smaller  peak 
magnitude  and  longer  duration.  This  is  exactly  what  the  model  predicts. 
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Figure  8.6:  Model  generated  impact  force  as  a  function  of  time 
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Figure  8.7:  Measured  impact  force  as  a  function  of  time 
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8.3  A  Neural  Network  Impact  Controller 


For  some  robotic  applications,  it  is  desirable  to  control  the  peak  magnitude  of 
the  impact  force  between  the  manipulator  and  some  object.  Using  a  robot  to 
hammer  a  nail  into  a  board,  hit  a  ball,  or  stamp  some  design  onto  a  piece  of  metal 
are  examples  of  such  tasks.  Here,  a  neural  network  is  trained  from  experimental 
data  to  generate  an  open  loop  motor  control  signal  which  will  bring  the  arm  into 
contact  with  the  sphere  to  create  a  specified  impact  force. 


8.3.1  The  Input  Signal 


In  order  to  simplify  the  problem,  a  one  dimensional  input  signal  will  be  used. 
The  input  signal  to  the  motor  will  be  defined  as 


uT(t)  =  < 


1  if  t  <T 
0  if  t>T 


(8.14) 


where  T  >  0.  Hence,  the  input  signal  uT(t)  is  parameterized  by  a  single  param¬ 
eter,  the  switching  time  T.  Figure  8.8  shows  a  graph  of  ur{t). 

Now  a  neural  network  can  be  trained  to  generate  the  switching  time  T  from 
the  desired  impact  force  magnitude. 


8.3.2  Collecting  Data 

The  aluminum  sphere  is  placed  so  that  the  undeflected  beam  will  collide  with 
the  sphere  when  60  =  0.  The  starting  position  of  the  motor  hub  is  90  =  —180°. 
The  signal  ur(f)  is  generated  by  the  AC-100,  amplified  by  a  power  amp,  and  fed 
to  the  motor.  The  impact  is  measured  with  the  FSR  mounted  to  the  beam  as 
discussed  in  Section  8.1. 
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Figure  8.8:  Motor  control  signal  parameterized  by  T 

To  generate  the  data  necessary  to  train  the  neural  network,  the  magnitude 
of  the  impact  force  is  measured  and  recorded  for  a  series  of  different  switching 
times.  The  first  switching  time  was  arbitrarily  chosen  to  be  T  =  0.10  seconds. 
The  switching  time  was  then  incremented  by  0.02  seconds  until  the  impact  force 
became  large  enough  to  saturate  the  FSR,  about  800  g.  This  happened  at 
T  =  0.7  seconds.  A  plot  of  impact  magnitude  versus  switching  time  is  shown  in 
Figure  8.9.  As  shown  in  the  plot,  the  first  non-zero  impact  magnitude  occurred 
at  T  =  0.39  seconds. 

8.3.3  Training  the  Neural  Network 

The  data  obtained  in  the  previous  section  is  used  to  train  a  single  input,  single 
output  backpropagation  neural  network  which  will  ultimately  serve  as  the  con¬ 
troller.  The  network  is  chosen  to  be  two  layers  with  ten  nodes  in  each  layer.  The 
first  layer  uses  sigmoid  transfer  functions  and  the  second  layer  uses  linear  trans¬ 
fer  functions.  This  structure  is  capable  of  approximating  any  practical  function 
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Figure  8.9:  Training  data  for  neural  network 
arbitrarily  well  [7]. 

Since  the  controller  will  need  to  specify  the  switching  time  as  a  function  of 
desired  impact,  the  impact  forces  measured  in  the  previous  section  are  presented 
to  the  neural  network  as  inputs  and  the  corresponding  switching  times  are  pre¬ 
sented  as  target  outputs.  The  network  is  trained  using  the  tools  available  in  the 
MATLAB  Neural  Network  Toolbox.  A  plot  of  the  input  of  the  trained  neural 
network  to  its  output  is  shown  in  Figure  8.10.  This  compares  quite  well  with 
the  actual  data  shown  in  Figure  8.9. 

8.3.4  Implementation 

The  neural  network  controller  is  implemented  using  the  AC- 100  as  shown  in  the 
block  diagram  of  Figure  8.11.  The  system  takes  a  desired  impact  magnitude 
as  input,  then  uses  the  neural  network  to  generate  an  open  loop  control  signal 
which  moves  the  arm  to  impact  with  the  sphere  at  the  desired  magnitude.  Figure 
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Figure  8.10:  Performance  of  trained  neural  network 

8.12  shows  a  plot  of  actual  impact  versus  desired  input.  If  the  controller  worked 
perfectly,  this  would  be  a  straight  45°  line.  As  the  graph  shows,  this  controller  is 
not  perfect,  but  it  performs  reasonably  well,  particulaly  for  impact  forces  above 
350  g. 


8.4  Conclusion 

Models  which  can  predict  the  general  behaviour  of  the  impact  forces  involved  in 
the  collision  between  flexible  bodies  have  been  developed.  The  next  step  is  to 
use  these  models  to  generate  good  schemes  for  controlling  the  impact  dynamics 
of  flexible  systems.  This  topic  is  the  subject  of  much  recent  work  and  will 
undoubtably  be  the  subject  of  much  future  work  as  well.  Here  experimental 
data  has  been  used  to  create  a  controller  which  is  capable  of  controlling  the 
magnitude  of  impact  between  a  flexible  arm  and  a  fixed  sphere.  This  controller 


108 


Figure  8.11:  Block  diagram  of  neural  network  controller 


Figure  8.12:  Performance  of  neural  network  controller 
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is  open  loop  and  its  performance  is  easily  diminished  by  disturbances  to  the 
system.  Closing  the  loop  is  left  as  a  subject  for  future  work. 
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Chapter  9 


Conclusion 


This  thesis  investigates  some  of  the  issues  involved  in  controlling  systems  com¬ 
posed  of  smart  materials.  Some  theoretical  concepts  are  discussed  and  some  are 
put  into  practice.  As  always,  there  is  much  room  for  future  work. 

A  method  of  finding  a  closed  loop  control  law  capable  of  stabilizing  an  un¬ 
stable  linear  plant  for  every  initial  condition  in  its  controllable  set  is  developed 
in  Chapters  2  and  3.  The  availability  of  such  a  control  law  is  important,  but  its 
implementation  is  clumsy.  An  elegant  solution  to  this  problem  would  be  a  useful 
tool  in  the  design  of  controllers  for  smart  structures. 

The  work  presented  in  Chapters  4  and  5  results  in  a  general  purpose  test 
bed  for  controllers.  The  AC-100  along  with  the  automatic  system  identification 
software  provides  a  means  by  which  new  control  concepts  can  be  rapidly  verified 
in  a  real  world  application.  This  test  bed  may  not  be  the  subject  of  future  work, 
but  it  will  almost  certainly  be  used  as  a  research  tool  for  future  projects. 

The  experimental  work  done  in  Chapters  6  and  7  validates  the  use  of  PZTs  as 
actuators  in  smart  materials  as  well  as  providing  a  demonstration  of  the  test  bed 
developed  in  the  previous  chapters.  The  controllers  developed  here  successfully 
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damped  the  vibrations  in  the  flexible  beam  using  one  sensor  and  one  actuator. 
Distributed  control  using  multiple  sensors  and  actuators  is  the  logical  next  step. 

Chapter  8  presents  the  problem  of  controlling  a  flexible  robotic  manipulator 
subject  to  impact  forces.  A  model  to  predict  the  impact  forces  caused  in  a  colli¬ 
sion  was  generated.  The  general  behavior  of  its  predictions  compared  favorably 
with  experimental  results.  An  open  loop  controller  was  developed  to  control  the 
magnitude  of  impact.  The  subject  of  impact  leaves  a  many  unanswered  ques¬ 
tions.  Closing  the  loop  on  the  impact  magnitude  controller  developed  here  would 
be  a  nice  result.  Another  interesting  problem  which  follows  directly  from  this 
work  is  to  use  PZTs  to  control  vibrations  generated  in  the  arm  due  to  impact. 
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